Pileus Git - ~andy/linux/blob - drivers/media/usb/dvb-usb-v2/az6007.c

   1 /*
   2  * Driver for AzureWave 6007 DVB-C/T USB2.0 and clones
   3  *
   4  * Copyright (c) Henry Wang <Henry.wang@AzureWave.com>
   5  *
   6  * This driver was made publicly available by Terratec, at:
   7  *      http://linux.terratec.de/files/TERRATEC_H7/20110323_TERRATEC_H7_Linux.tar.gz
   8  * The original driver's license is GPL, as declared with MODULE_LICENSE()
   9  *
  10  * Copyright (c) 2010-2012 Mauro Carvalho Chehab <mchehab@redhat.com>
  11  *      Driver modified by in order to work with upstream drxk driver, and
  12  *      tons of bugs got fixed, and converted to use dvb-usb-v2.
  13  *
  14  * This program is free software; you can redistribute it and/or modify
  15  * it under the terms of the GNU General Public License as published by
  16  * the Free Software Foundation under version 2 of the License.
  17  *
  18  * This program is distributed in the hope that it will be useful,
  19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  21  * GNU General Public License for more details.
  22  */
  23
  24 #include "drxk.h"
  25 #include "mt2063.h"
  26 #include "dvb_ca_en50221.h"
  27 #include "dvb_usb.h"
  28 #include "cypress_firmware.h"
  29
  30 #define AZ6007_FIRMWARE "dvb-usb-terratec-h7-az6007.fw"
  31
  32 static int az6007_xfer_debug;
  33 module_param_named(xfer_debug, az6007_xfer_debug, int, 0644);
  34 MODULE_PARM_DESC(xfer_debug, "Enable xfer debug");
  35
  36 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
  37
  38 /* Known requests (Cypress FX2 firmware + az6007 "private" ones*/
  39
  40 #define FX2_OED                 0xb5
  41 #define AZ6007_READ_DATA        0xb7
  42 #define AZ6007_I2C_RD           0xb9
  43 #define AZ6007_POWER            0xbc
  44 #define AZ6007_I2C_WR           0xbd
  45 #define FX2_SCON1               0xc0
  46 #define AZ6007_TS_THROUGH       0xc7
  47 #define AZ6007_READ_IR          0xb4
  48
  49 struct az6007_device_state {
  50         struct mutex            mutex;
  51         struct mutex            ca_mutex;
  52         struct dvb_ca_en50221   ca;
  53         unsigned                warm:1;
  54         int                     (*gate_ctrl) (struct dvb_frontend *, int);
  55         unsigned char           data[4096];
  56 };
  57
  58 static struct drxk_config terratec_h7_drxk = {
  59         .adr = 0x29,
  60         .parallel_ts = true,
  61         .dynamic_clk = true,
  62         .single_master = true,
  63         .enable_merr_cfg = true,
  64         .no_i2c_bridge = false,
  65         .chunk_size = 64,
  66         .mpeg_out_clk_strength = 0x02,
  67         .qam_demod_parameter_count = 2,
  68         .microcode_name = "dvb-usb-terratec-h7-drxk.fw",
  69 };
  70
  71 static int drxk_gate_ctrl(struct dvb_frontend *fe, int enable)
  72 {
  73         struct az6007_device_state *st = fe_to_priv(fe);
  74         struct dvb_usb_adapter *adap = fe->sec_priv;
  75         int status = 0;
  76
  77         pr_debug("%s: %s\n", __func__, enable ? "enable" : "disable");
  78
  79         if (!adap || !st)
  80                 return -EINVAL;
  81
  82         if (enable)
  83                 status = st->gate_ctrl(fe, 1);
  84         else
  85                 status = st->gate_ctrl(fe, 0);
  86
  87         return status;
  88 }
  89
  90 static struct mt2063_config az6007_mt2063_config = {
  91         .tuner_address = 0x60,
  92         .refclock = 36125000,
  93 };
  94
  95 static int __az6007_read(struct usb_device *udev, u8 req, u16 value,
  96                             u16 index, u8 *b, int blen)
  97 {
  98         int ret;
  99
 100         ret = usb_control_msg(udev,
 101                               usb_rcvctrlpipe(udev, 0),
 102                               req,
 103                               USB_TYPE_VENDOR | USB_DIR_IN,
 104                               value, index, b, blen, 5000);
 105         if (ret < 0) {
 106                 pr_warn("usb read operation failed. (%d)\n", ret);
 107                 return -EIO;
 108         }
 109
 110         if (az6007_xfer_debug) {
 111                 printk(KERN_DEBUG "az6007: IN  req: %02x, value: %04x, index: %04x\n",
 112                        req, value, index);
 113                 print_hex_dump_bytes("az6007: payload: ",
 114                                      DUMP_PREFIX_NONE, b, blen);
 115         }
 116
 117         return ret;
 118 }
 119
 120 static int az6007_read(struct dvb_usb_device *d, u8 req, u16 value,
 121                             u16 index, u8 *b, int blen)
 122 {
 123         struct az6007_device_state *st = d->priv;
 124         int ret;
 125
 126         if (mutex_lock_interruptible(&st->mutex) < 0)
 127                 return -EAGAIN;
 128
 129         ret = __az6007_read(d->udev, req, value, index, b, blen);
 130
 131         mutex_unlock(&st->mutex);
 132
 133         return ret;
 134 }
 135
 136 static int __az6007_write(struct usb_device *udev, u8 req, u16 value,
 137                              u16 index, u8 *b, int blen)
 138 {
 139         int ret;
 140
 141         if (az6007_xfer_debug) {
 142                 printk(KERN_DEBUG "az6007: OUT req: %02x, value: %04x, index: %04x\n",
 143                        req, value, index);
 144                 print_hex_dump_bytes("az6007: payload: ",
 145                                      DUMP_PREFIX_NONE, b, blen);
 146         }
 147
 148         if (blen > 64) {
 149                 pr_err("az6007: tried to write %d bytes, but I2C max size is 64 bytes\n",
 150                        blen);
 151                 return -EOPNOTSUPP;
 152         }
 153
 154         ret = usb_control_msg(udev,
 155                               usb_sndctrlpipe(udev, 0),
 156                               req,
 157                               USB_TYPE_VENDOR | USB_DIR_OUT,
 158                               value, index, b, blen, 5000);
 159         if (ret != blen) {
 160                 pr_err("usb write operation failed. (%d)\n", ret);
 161                 return -EIO;
 162         }
 163
 164         return 0;
 165 }
 166
 167 static int az6007_write(struct dvb_usb_device *d, u8 req, u16 value,
 168                             u16 index, u8 *b, int blen)
 169 {
 170         struct az6007_device_state *st = d->priv;
 171         int ret;
 172
 173         if (mutex_lock_interruptible(&st->mutex) < 0)
 174                 return -EAGAIN;
 175
 176         ret = __az6007_write(d->udev, req, value, index, b, blen);
 177
 178         mutex_unlock(&st->mutex);
 179
 180         return ret;
 181 }
 182
 183 static int az6007_streaming_ctrl(struct dvb_frontend *fe, int onoff)
 184 {
 185         struct dvb_usb_device *d = fe_to_d(fe);
 186
 187         pr_debug("%s: %s\n", __func__, onoff ? "enable" : "disable");
 188
 189         return az6007_write(d, 0xbc, onoff, 0, NULL, 0);
 190 }
 191
 192 /* remote control stuff (does not work with my box) */
 193 static int az6007_rc_query(struct dvb_usb_device *d)
 194 {
 195         struct az6007_device_state *st = d_to_priv(d);
 196         unsigned code = 0;
 197
 198         az6007_read(d, AZ6007_READ_IR, 0, 0, st->data, 10);
 199
 200         if (st->data[1] == 0x44)
 201                 return 0;
 202
 203         if ((st->data[1] ^ st->data[2]) == 0xff)
 204                 code = st->data[1];
 205         else
 206                 code = st->data[1] << 8 | st->data[2];
 207
 208         if ((st->data[3] ^ st->data[4]) == 0xff)
 209                 code = code << 8 | st->data[3];
 210         else
 211                 code = code << 16 | st->data[3] << 8 | st->data[4];
 212
 213         rc_keydown(d->rc_dev, code, st->data[5]);
 214
 215         return 0;
 216 }
 217
 218 static int az6007_ci_read_attribute_mem(struct dvb_ca_en50221 *ca,
 219                                         int slot,
 220                                         int address)
 221 {
 222         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
 223         struct az6007_device_state *state = d_to_priv(d);
 224
 225         int ret;
 226         u8 req;
 227         u16 value;
 228         u16 index;
 229         int blen;
 230         u8 *b;
 231
 232         if (slot != 0)
 233                 return -EINVAL;
 234
 235         b = kmalloc(12, GFP_KERNEL);
 236         if (!b)
 237                 return -ENOMEM;
 238
 239         mutex_lock(&state->ca_mutex);
 240
 241         req = 0xC1;
 242         value = address;
 243         index = 0;
 244         blen = 1;
 245
 246         ret = az6007_read(d, req, value, index, b, blen);
 247         if (ret < 0) {
 248                 pr_warn("usb in operation failed. (%d)\n", ret);
 249                 ret = -EINVAL;
 250         } else {
 251                 ret = b[0];
 252         }
 253
 254         mutex_unlock(&state->ca_mutex);
 255         kfree(b);
 256         return ret;
 257 }
 258
 259 static int az6007_ci_write_attribute_mem(struct dvb_ca_en50221 *ca,
 260                                          int slot,
 261                                          int address,
 262                                          u8 value)
 263 {
 264         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
 265         struct az6007_device_state *state = d_to_priv(d);
 266
 267         int ret;
 268         u8 req;
 269         u16 value1;
 270         u16 index;
 271         int blen;
 272
 273         pr_debug("%s(), slot %d\n", __func__, slot);
 274         if (slot != 0)
 275                 return -EINVAL;
 276
 277         mutex_lock(&state->ca_mutex);
 278         req = 0xC2;
 279         value1 = address;
 280         index = value;
 281         blen = 0;
 282
 283         ret = az6007_write(d, req, value1, index, NULL, blen);
 284         if (ret != 0)
 285                 pr_warn("usb out operation failed. (%d)\n", ret);
 286
 287         mutex_unlock(&state->ca_mutex);
 288         return ret;
 289 }
 290
 291 static int az6007_ci_read_cam_control(struct dvb_ca_en50221 *ca,
 292                                       int slot,
 293                                       u8 address)
 294 {
 295         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
 296         struct az6007_device_state *state = d_to_priv(d);
 297
 298         int ret;
 299         u8 req;
 300         u16 value;
 301         u16 index;
 302         int blen;
 303         u8 *b;
 304
 305         if (slot != 0)
 306                 return -EINVAL;
 307
 308         b = kmalloc(12, GFP_KERNEL);
 309         if (!b)
 310                 return -ENOMEM;
 311
 312         mutex_lock(&state->ca_mutex);
 313
 314         req = 0xC3;
 315         value = address;
 316         index = 0;
 317         blen = 2;
 318
 319         ret = az6007_read(d, req, value, index, b, blen);
 320         if (ret < 0) {
 321                 pr_warn("usb in operation failed. (%d)\n", ret);
 322                 ret = -EINVAL;
 323         } else {
 324                 if (b[0] == 0)
 325                         pr_warn("Read CI IO error\n");
 326
 327                 ret = b[1];
 328                 pr_debug("read cam data = %x from 0x%x\n", b[1], value);
 329         }
 330
 331         mutex_unlock(&state->ca_mutex);
 332         kfree(b);
 333         return ret;
 334 }
 335
 336 static int az6007_ci_write_cam_control(struct dvb_ca_en50221 *ca,
 337                                        int slot,
 338                                        u8 address,
 339                                        u8 value)
 340 {
 341         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
 342         struct az6007_device_state *state = d_to_priv(d);
 343
 344         int ret;
 345         u8 req;
 346         u16 value1;
 347         u16 index;
 348         int blen;
 349
 350         if (slot != 0)
 351                 return -EINVAL;
 352
 353         mutex_lock(&state->ca_mutex);
 354         req = 0xC4;
 355         value1 = address;
 356         index = value;
 357         blen = 0;
 358
 359         ret = az6007_write(d, req, value1, index, NULL, blen);
 360         if (ret != 0) {
 361                 pr_warn("usb out operation failed. (%d)\n", ret);
 362                 goto failed;
 363         }
 364
 365 failed:
 366         mutex_unlock(&state->ca_mutex);
 367         return ret;
 368 }
 369
 370 static int CI_CamReady(struct dvb_ca_en50221 *ca, int slot)
 371 {
 372         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
 373
 374         int ret;
 375         u8 req;
 376         u16 value;
 377         u16 index;
 378         int blen;
 379         u8 *b;
 380
 381         b = kmalloc(12, GFP_KERNEL);
 382         if (!b)
 383                 return -ENOMEM;
 384
 385         req = 0xC8;
 386         value = 0;
 387         index = 0;
 388         blen = 1;
 389
 390         ret = az6007_read(d, req, value, index, b, blen);
 391         if (ret < 0) {
 392                 pr_warn("usb in operation failed. (%d)\n", ret);
 393                 ret = -EIO;
 394         } else{
 395                 ret = b[0];
 396         }
 397         kfree(b);
 398         return ret;
 399 }
 400
 401 static int az6007_ci_slot_reset(struct dvb_ca_en50221 *ca, int slot)
 402 {
 403         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
 404         struct az6007_device_state *state = d_to_priv(d);
 405
 406         int ret, i;
 407         u8 req;
 408         u16 value;
 409         u16 index;
 410         int blen;
 411
 412         mutex_lock(&state->ca_mutex);
 413
 414         req = 0xC6;
 415         value = 1;
 416         index = 0;
 417         blen = 0;
 418
 419         ret = az6007_write(d, req, value, index, NULL, blen);
 420         if (ret != 0) {
 421                 pr_warn("usb out operation failed. (%d)\n", ret);
 422                 goto failed;
 423         }
 424
 425         msleep(500);
 426         req = 0xC6;
 427         value = 0;
 428         index = 0;
 429         blen = 0;
 430
 431         ret = az6007_write(d, req, value, index, NULL, blen);
 432         if (ret != 0) {
 433                 pr_warn("usb out operation failed. (%d)\n", ret);
 434                 goto failed;
 435         }
 436
 437         for (i = 0; i < 15; i++) {
 438                 msleep(100);
 439
 440                 if (CI_CamReady(ca, slot)) {
 441                         pr_debug("CAM Ready\n");
 442                         break;
 443                 }
 444         }
 445         msleep(5000);
 446
 447 failed:
 448         mutex_unlock(&state->ca_mutex);
 449         return ret;
 450 }
 451
 452 static int az6007_ci_slot_shutdown(struct dvb_ca_en50221 *ca, int slot)
 453 {
 454         return 0;
 455 }
 456
 457 static int az6007_ci_slot_ts_enable(struct dvb_ca_en50221 *ca, int slot)
 458 {
 459         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
 460         struct az6007_device_state *state = d_to_priv(d);
 461
 462         int ret;
 463         u8 req;
 464         u16 value;
 465         u16 index;
 466         int blen;
 467
 468         pr_debug("%s()\n", __func__);
 469         mutex_lock(&state->ca_mutex);
 470         req = 0xC7;
 471         value = 1;
 472         index = 0;
 473         blen = 0;
 474
 475         ret = az6007_write(d, req, value, index, NULL, blen);
 476         if (ret != 0) {
 477                 pr_warn("usb out operation failed. (%d)\n", ret);
 478                 goto failed;
 479         }
 480
 481 failed:
 482         mutex_unlock(&state->ca_mutex);
 483         return ret;
 484 }
 485
 486 static int az6007_ci_poll_slot_status(struct dvb_ca_en50221 *ca, int slot, int open)
 487 {
 488         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
 489         struct az6007_device_state *state = d_to_priv(d);
 490         int ret;
 491         u8 req;
 492         u16 value;
 493         u16 index;
 494         int blen;
 495         u8 *b;
 496
 497         b = kmalloc(12, GFP_KERNEL);
 498         if (!b)
 499                 return -ENOMEM;
 500         mutex_lock(&state->ca_mutex);
 501
 502         req = 0xC5;
 503         value = 0;
 504         index = 0;
 505         blen = 1;
 506
 507         ret = az6007_read(d, req, value, index, b, blen);
 508         if (ret < 0) {
 509                 pr_warn("usb in operation failed. (%d)\n", ret);
 510                 ret = -EIO;
 511         } else
 512                 ret = 0;
 513
 514         if (!ret && b[0] == 1) {
 515                 ret = DVB_CA_EN50221_POLL_CAM_PRESENT |
 516                       DVB_CA_EN50221_POLL_CAM_READY;
 517         }
 518
 519         mutex_unlock(&state->ca_mutex);
 520         kfree(b);
 521         return ret;
 522 }
 523
 524
 525 static void az6007_ci_uninit(struct dvb_usb_device *d)
 526 {
 527         struct az6007_device_state *state;
 528
 529         pr_debug("%s()\n", __func__);
 530
 531         if (NULL == d)
 532                 return;
 533
 534         state = d_to_priv(d);
 535         if (NULL == state)
 536                 return;
 537
 538         if (NULL == state->ca.data)
 539                 return;
 540
 541         dvb_ca_en50221_release(&state->ca);
 542
 543         memset(&state->ca, 0, sizeof(state->ca));
 544 }
 545
 546
 547 static int az6007_ci_init(struct dvb_usb_adapter *adap)
 548 {
 549         struct dvb_usb_device *d = adap_to_d(adap);
 550         struct az6007_device_state *state = adap_to_priv(adap);
 551         int ret;
 552
 553         pr_debug("%s()\n", __func__);
 554
 555         mutex_init(&state->ca_mutex);
 556         state->ca.owner                 = THIS_MODULE;
 557         state->ca.read_attribute_mem    = az6007_ci_read_attribute_mem;
 558         state->ca.write_attribute_mem   = az6007_ci_write_attribute_mem;
 559         state->ca.read_cam_control      = az6007_ci_read_cam_control;
 560         state->ca.write_cam_control     = az6007_ci_write_cam_control;
 561         state->ca.slot_reset            = az6007_ci_slot_reset;
 562         state->ca.slot_shutdown         = az6007_ci_slot_shutdown;
 563         state->ca.slot_ts_enable        = az6007_ci_slot_ts_enable;
 564         state->ca.poll_slot_status      = az6007_ci_poll_slot_status;
 565         state->ca.data                  = d;
 566
 567         ret = dvb_ca_en50221_init(&adap->dvb_adap,
 568                                   &state->ca,
 569                                   0, /* flags */
 570                                   1);/* n_slots */
 571         if (ret != 0) {
 572                 pr_err("Cannot initialize CI: Error %d.\n", ret);
 573                 memset(&state->ca, 0, sizeof(state->ca));
 574                 return ret;
 575         }
 576
 577         pr_debug("CI initialized.\n");
 578
 579         return 0;
 580 }
 581
 582 static int az6007_read_mac_addr(struct dvb_usb_adapter *adap, u8 mac[6])
 583 {
 584         struct dvb_usb_device *d = adap_to_d(adap);
 585         struct az6007_device_state *st = adap_to_priv(adap);
 586         int ret;
 587
 588         ret = az6007_read(d, AZ6007_READ_DATA, 6, 0, st->data, 6);
 589         memcpy(mac, st->data, 6);
 590
 591         if (ret > 0)
 592                 pr_debug("%s: mac is %pM\n", __func__, mac);
 593
 594         return ret;
 595 }
 596
 597 static int az6007_frontend_attach(struct dvb_usb_adapter *adap)
 598 {
 599         struct az6007_device_state *st = adap_to_priv(adap);
 600         struct dvb_usb_device *d = adap_to_d(adap);
 601
 602         pr_debug("attaching demod drxk\n");
 603
 604         adap->fe[0] = dvb_attach(drxk_attach, &terratec_h7_drxk,
 605                                  &d->i2c_adap);
 606         if (!adap->fe[0])
 607                 return -EINVAL;
 608
 609         adap->fe[0]->sec_priv = adap;
 610         st->gate_ctrl = adap->fe[0]->ops.i2c_gate_ctrl;
 611         adap->fe[0]->ops.i2c_gate_ctrl = drxk_gate_ctrl;
 612
 613         az6007_ci_init(adap);
 614
 615         return 0;
 616 }
 617
 618 static int az6007_tuner_attach(struct dvb_usb_adapter *adap)
 619 {
 620         struct dvb_usb_device *d = adap_to_d(adap);
 621
 622         pr_debug("attaching tuner mt2063\n");
 623
 624         /* Attach mt2063 to DVB-C frontend */
 625         if (adap->fe[0]->ops.i2c_gate_ctrl)
 626                 adap->fe[0]->ops.i2c_gate_ctrl(adap->fe[0], 1);
 627         if (!dvb_attach(mt2063_attach, adap->fe[0],
 628                         &az6007_mt2063_config,
 629                         &d->i2c_adap))
 630                 return -EINVAL;
 631
 632         if (adap->fe[0]->ops.i2c_gate_ctrl)
 633                 adap->fe[0]->ops.i2c_gate_ctrl(adap->fe[0], 0);
 634
 635         return 0;
 636 }
 637
 638 static int az6007_power_ctrl(struct dvb_usb_device *d, int onoff)
 639 {
 640         struct az6007_device_state *state = d_to_priv(d);
 641         int ret;
 642
 643         pr_debug("%s()\n", __func__);
 644
 645         if (!state->warm) {
 646                 mutex_init(&state->mutex);
 647
 648                 ret = az6007_write(d, AZ6007_POWER, 0, 2, NULL, 0);
 649                 if (ret < 0)
 650                         return ret;
 651                 msleep(60);
 652                 ret = az6007_write(d, AZ6007_POWER, 1, 4, NULL, 0);
 653                 if (ret < 0)
 654                         return ret;
 655                 msleep(100);
 656                 ret = az6007_write(d, AZ6007_POWER, 1, 3, NULL, 0);
 657                 if (ret < 0)
 658                         return ret;
 659                 msleep(20);
 660                 ret = az6007_write(d, AZ6007_POWER, 1, 4, NULL, 0);
 661                 if (ret < 0)
 662                         return ret;
 663
 664                 msleep(400);
 665                 ret = az6007_write(d, FX2_SCON1, 0, 3, NULL, 0);
 666                 if (ret < 0)
 667                         return ret;
 668                 msleep(150);
 669                 ret = az6007_write(d, FX2_SCON1, 1, 3, NULL, 0);
 670                 if (ret < 0)
 671                         return ret;
 672                 msleep(430);
 673                 ret = az6007_write(d, AZ6007_POWER, 0, 0, NULL, 0);
 674                 if (ret < 0)
 675                         return ret;
 676
 677                 state->warm = true;
 678
 679                 return 0;
 680         }
 681
 682         if (!onoff)
 683                 return 0;
 684
 685         az6007_write(d, AZ6007_POWER, 0, 0, NULL, 0);
 686         az6007_write(d, AZ6007_TS_THROUGH, 0, 0, NULL, 0);
 687
 688         return 0;
 689 }
 690
 691 /* I2C */
 692 static int az6007_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[],
 693                            int num)
 694 {
 695         struct dvb_usb_device *d = i2c_get_adapdata(adap);
 696         struct az6007_device_state *st = d_to_priv(d);
 697         int i, j, len;
 698         int ret = 0;
 699         u16 index;
 700         u16 value;
 701         int length;
 702         u8 req, addr;
 703
 704         if (mutex_lock_interruptible(&st->mutex) < 0)
 705                 return -EAGAIN;
 706
 707         for (i = 0; i < num; i++) {
 708                 addr = msgs[i].addr << 1;
 709                 if (((i + 1) < num)
 710                     && (msgs[i].len == 1)
 711                     && ((msgs[i].flags & I2C_M_RD) != I2C_M_RD)
 712                     && (msgs[i + 1].flags & I2C_M_RD)
 713                     && (msgs[i].addr == msgs[i + 1].addr)) {
 714                         /*
 715                          * A write + read xfer for the same address, where
 716                          * the first xfer has just 1 byte length.
 717                          * Need to join both into one operation
 718                          */
 719                         if (az6007_xfer_debug)
 720                                 printk(KERN_DEBUG "az6007: I2C W/R addr=0x%x len=%d/%d\n",
 721                                        addr, msgs[i].len, msgs[i + 1].len);
 722                         req = AZ6007_I2C_RD;
 723                         index = msgs[i].buf[0];
 724                         value = addr | (1 << 8);
 725                         length = 6 + msgs[i + 1].len;
 726                         len = msgs[i + 1].len;
 727                         ret = __az6007_read(d->udev, req, value, index,
 728                                             st->data, length);
 729                         if (ret >= len) {
 730                                 for (j = 0; j < len; j++)
 731                                         msgs[i + 1].buf[j] = st->data[j + 5];
 732                         } else
 733                                 ret = -EIO;
 734                         i++;
 735                 } else if (!(msgs[i].flags & I2C_M_RD)) {
 736                         /* write bytes */
 737                         if (az6007_xfer_debug)
 738                                 printk(KERN_DEBUG "az6007: I2C W addr=0x%x len=%d\n",
 739                                        addr, msgs[i].len);
 740                         req = AZ6007_I2C_WR;
 741                         index = msgs[i].buf[0];
 742                         value = addr | (1 << 8);
 743                         length = msgs[i].len - 1;
 744                         len = msgs[i].len - 1;
 745                         for (j = 0; j < len; j++)
 746                                 st->data[j] = msgs[i].buf[j + 1];
 747                         ret =  __az6007_write(d->udev, req, value, index,
 748                                               st->data, length);
 749                 } else {
 750                         /* read bytes */
 751                         if (az6007_xfer_debug)
 752                                 printk(KERN_DEBUG "az6007: I2C R addr=0x%x len=%d\n",
 753                                        addr, msgs[i].len);
 754                         req = AZ6007_I2C_RD;
 755                         index = msgs[i].buf[0];
 756                         value = addr;
 757                         length = msgs[i].len + 6;
 758                         len = msgs[i].len;
 759                         ret = __az6007_read(d->udev, req, value, index,
 760                                             st->data, length);
 761                         for (j = 0; j < len; j++)
 762                                 msgs[i].buf[j] = st->data[j + 5];
 763                 }
 764                 if (ret < 0)
 765                         goto err;
 766         }
 767 err:
 768         mutex_unlock(&st->mutex);
 769
 770         if (ret < 0) {
 771                 pr_info("%s ERROR: %i\n", __func__, ret);
 772                 return ret;
 773         }
 774         return num;
 775 }
 776
 777 static u32 az6007_i2c_func(struct i2c_adapter *adapter)
 778 {
 779         return I2C_FUNC_I2C;
 780 }
 781
 782 static struct i2c_algorithm az6007_i2c_algo = {
 783         .master_xfer = az6007_i2c_xfer,
 784         .functionality = az6007_i2c_func,
 785 };
 786
 787 static int az6007_identify_state(struct dvb_usb_device *d, const char **name)
 788 {
 789         int ret;
 790         u8 *mac;
 791
 792         pr_debug("Identifying az6007 state\n");
 793
 794         mac = kmalloc(6, GFP_ATOMIC);
 795         if (!mac)
 796                 return -ENOMEM;
 797
 798         /* Try to read the mac address */
 799         ret = __az6007_read(d->udev, AZ6007_READ_DATA, 6, 0, mac, 6);
 800         if (ret == 6)
 801                 ret = WARM;
 802         else
 803                 ret = COLD;
 804
 805         kfree(mac);
 806
 807         if (ret == COLD) {
 808                 __az6007_write(d->udev, 0x09, 1, 0, NULL, 0);
 809                 __az6007_write(d->udev, 0x00, 0, 0, NULL, 0);
 810                 __az6007_write(d->udev, 0x00, 0, 0, NULL, 0);
 811         }
 812
 813         pr_debug("Device is on %s state\n",
 814                  ret == WARM ? "warm" : "cold");
 815         return ret;
 816 }
 817
 818 static void az6007_usb_disconnect(struct usb_interface *intf)
 819 {
 820         struct dvb_usb_device *d = usb_get_intfdata(intf);
 821         az6007_ci_uninit(d);
 822         dvb_usbv2_disconnect(intf);
 823 }
 824
 825 static int az6007_get_rc_config(struct dvb_usb_device *d, struct dvb_usb_rc *rc)
 826 {
 827         pr_debug("Getting az6007 Remote Control properties\n");
 828
 829         rc->allowed_protos = RC_TYPE_NEC;
 830         rc->query          = az6007_rc_query;
 831         rc->interval       = 400;
 832
 833         return 0;
 834 }
 835
 836 static int az6007_download_firmware(struct dvb_usb_device *d,
 837         const struct firmware *fw)
 838 {
 839         pr_debug("Loading az6007 firmware\n");
 840
 841         return usbv2_cypress_load_firmware(d->udev, fw, CYPRESS_FX2);
 842 }
 843
 844 /* DVB USB Driver stuff */
 845 static struct dvb_usb_device_properties az6007_props = {
 846         .driver_name         = KBUILD_MODNAME,
 847         .owner               = THIS_MODULE,
 848         .firmware            = AZ6007_FIRMWARE,
 849
 850         .adapter_nr          = adapter_nr,
 851         .size_of_priv        = sizeof(struct az6007_device_state),
 852         .i2c_algo            = &az6007_i2c_algo,
 853         .tuner_attach        = az6007_tuner_attach,
 854         .frontend_attach     = az6007_frontend_attach,
 855         .streaming_ctrl      = az6007_streaming_ctrl,
 856         .get_rc_config       = az6007_get_rc_config,
 857         .read_mac_address    = az6007_read_mac_addr,
 858         .download_firmware   = az6007_download_firmware,
 859         .identify_state      = az6007_identify_state,
 860         .power_ctrl          = az6007_power_ctrl,
 861         .num_adapters        = 1,
 862         .adapter             = {
 863                 { .stream = DVB_USB_STREAM_BULK(0x02, 10, 4096), }
 864         }
 865 };
 866
 867 static struct usb_device_id az6007_usb_table[] = {
 868         {DVB_USB_DEVICE(USB_VID_AZUREWAVE, USB_PID_AZUREWAVE_6007,
 869                 &az6007_props, "Azurewave 6007", RC_MAP_EMPTY)},
 870         {DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_H7,
 871                 &az6007_props, "Terratec H7", RC_MAP_NEC_TERRATEC_CINERGY_XS)},
 872         {DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_H7_2,
 873                 &az6007_props, "Terratec H7", RC_MAP_NEC_TERRATEC_CINERGY_XS)},
 874         {0},
 875 };
 876
 877 MODULE_DEVICE_TABLE(usb, az6007_usb_table);
 878
 879 static int az6007_suspend(struct usb_interface *intf, pm_message_t msg)
 880 {
 881         struct dvb_usb_device *d = usb_get_intfdata(intf);
 882
 883         az6007_ci_uninit(d);
 884         return dvb_usbv2_suspend(intf, msg);
 885 }
 886
 887 static int az6007_resume(struct usb_interface *intf)
 888 {
 889         struct dvb_usb_device *d = usb_get_intfdata(intf);
 890         struct dvb_usb_adapter *adap = &d->adapter[0];
 891
 892         az6007_ci_init(adap);
 893         return dvb_usbv2_resume(intf);
 894 }
 895
 896 /* usb specific object needed to register this driver with the usb subsystem */
 897 static struct usb_driver az6007_usb_driver = {
 898         .name           = KBUILD_MODNAME,
 899         .id_table       = az6007_usb_table,
 900         .probe          = dvb_usbv2_probe,
 901         .disconnect     = az6007_usb_disconnect,
 902         .no_dynamic_id  = 1,
 903         .soft_unbind    = 1,
 904         /*
 905          * FIXME: need to implement reset_resume, likely with
 906          * dvb-usb-v2 core support
 907          */
 908         .suspend        = az6007_suspend,
 909         .resume         = az6007_resume,
 910 };
 911
 912 module_usb_driver(az6007_usb_driver);
 913
 914 MODULE_AUTHOR("Henry Wang <Henry.wang@AzureWave.com>");
 915 MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@redhat.com>");
 916 MODULE_DESCRIPTION("Driver for AzureWave 6007 DVB-C/T USB2.0 and clones");
 917 MODULE_VERSION("2.0");
 918 MODULE_LICENSE("GPL");
 919 MODULE_FIRMWARE(AZ6007_FIRMWARE);