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