drivers/media/usb/dvb-usb-v2/af9035.c

   1 /*
   2  * Afatech AF9035 DVB USB driver
   3  *
   4  * Copyright (C) 2009 Antti Palosaari <crope@iki.fi>
   5  * Copyright (C) 2012 Antti Palosaari <crope@iki.fi>
   6  *
   7  *    This program is free software; you can redistribute it and/or modify
   8  *    it under the terms of the GNU General Public License as published by
   9  *    the Free Software Foundation; either version 2 of the License, or
  10  *    (at your option) any later version.
  11  *
  12  *    This program is distributed in the hope that it will be useful,
  13  *    but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  *    GNU General Public License for more details.
  16  *
  17  *    You should have received a copy of the GNU General Public License along
  18  *    with this program; if not, write to the Free Software Foundation, Inc.,
  19  *    51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  20  */
  21
  22 #include "af9035.h"
  23
  24 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
  25
  26 static u16 af9035_checksum(const u8 *buf, size_t len)
  27 {
  28         size_t i;
  29         u16 checksum = 0;
  30
  31         for (i = 1; i < len; i++) {
  32                 if (i % 2)
  33                         checksum += buf[i] << 8;
  34                 else
  35                         checksum += buf[i];
  36         }
  37         checksum = ~checksum;
  38
  39         return checksum;
  40 }
  41
  42 static int af9035_ctrl_msg(struct dvb_usb_device *d, struct usb_req *req)
  43 {
  44 #define REQ_HDR_LEN 4 /* send header size */
  45 #define ACK_HDR_LEN 3 /* rece header size */
  46 #define CHECKSUM_LEN 2
  47 #define USB_TIMEOUT 2000
  48         struct state *state = d_to_priv(d);
  49         int ret, wlen, rlen;
  50         u16 checksum, tmp_checksum;
  51
  52         mutex_lock(&d->usb_mutex);
  53
  54         /* buffer overflow check */
  55         if (req->wlen > (BUF_LEN - REQ_HDR_LEN - CHECKSUM_LEN) ||
  56                         req->rlen > (BUF_LEN - ACK_HDR_LEN - CHECKSUM_LEN)) {
  57                 dev_err(&d->udev->dev, "%s: too much data wlen=%d rlen=%d\n",
  58                                 __func__, req->wlen, req->rlen);
  59                 ret = -EINVAL;
  60                 goto err;
  61         }
  62
  63         state->buf[0] = REQ_HDR_LEN + req->wlen + CHECKSUM_LEN - 1;
  64         state->buf[1] = req->mbox;
  65         state->buf[2] = req->cmd;
  66         state->buf[3] = state->seq++;
  67         memcpy(&state->buf[REQ_HDR_LEN], req->wbuf, req->wlen);
  68
  69         wlen = REQ_HDR_LEN + req->wlen + CHECKSUM_LEN;
  70         rlen = ACK_HDR_LEN + req->rlen + CHECKSUM_LEN;
  71
  72         /* calc and add checksum */
  73         checksum = af9035_checksum(state->buf, state->buf[0] - 1);
  74         state->buf[state->buf[0] - 1] = (checksum >> 8);
  75         state->buf[state->buf[0] - 0] = (checksum & 0xff);
  76
  77         /* no ack for these packets */
  78         if (req->cmd == CMD_FW_DL)
  79                 rlen = 0;
  80
  81         ret = dvb_usbv2_generic_rw_locked(d,
  82                         state->buf, wlen, state->buf, rlen);
  83         if (ret)
  84                 goto err;
  85
  86         /* no ack for those packets */
  87         if (req->cmd == CMD_FW_DL)
  88                 goto exit;
  89
  90         /* verify checksum */
  91         checksum = af9035_checksum(state->buf, rlen - 2);
  92         tmp_checksum = (state->buf[rlen - 2] << 8) | state->buf[rlen - 1];
  93         if (tmp_checksum != checksum) {
  94                 dev_err(&d->udev->dev, "%s: command=%02x checksum mismatch " \
  95                                 "(%04x != %04x)\n", KBUILD_MODNAME, req->cmd,
  96                                 tmp_checksum, checksum);
  97                 ret = -EIO;
  98                 goto err;
  99         }
 100
 101         /* check status */
 102         if (state->buf[2]) {
 103                 dev_dbg(&d->udev->dev, "%s: command=%02x failed fw error=%d\n",
 104                                 __func__, req->cmd, state->buf[2]);
 105                 ret = -EIO;
 106                 goto err;
 107         }
 108
 109         /* read request, copy returned data to return buf */
 110         if (req->rlen)
 111                 memcpy(req->rbuf, &state->buf[ACK_HDR_LEN], req->rlen);
 112 exit:
 113 err:
 114         mutex_unlock(&d->usb_mutex);
 115         if (ret)
 116                 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
 117         return ret;
 118 }
 119
 120 /* write multiple registers */
 121 static int af9035_wr_regs(struct dvb_usb_device *d, u32 reg, u8 *val, int len)
 122 {
 123         u8 wbuf[6 + len];
 124         u8 mbox = (reg >> 16) & 0xff;
 125         struct usb_req req = { CMD_MEM_WR, mbox, sizeof(wbuf), wbuf, 0, NULL };
 126
 127         wbuf[0] = len;
 128         wbuf[1] = 2;
 129         wbuf[2] = 0;
 130         wbuf[3] = 0;
 131         wbuf[4] = (reg >> 8) & 0xff;
 132         wbuf[5] = (reg >> 0) & 0xff;
 133         memcpy(&wbuf[6], val, len);
 134
 135         return af9035_ctrl_msg(d, &req);
 136 }
 137
 138 /* read multiple registers */
 139 static int af9035_rd_regs(struct dvb_usb_device *d, u32 reg, u8 *val, int len)
 140 {
 141         u8 wbuf[] = { len, 2, 0, 0, (reg >> 8) & 0xff, reg & 0xff };
 142         u8 mbox = (reg >> 16) & 0xff;
 143         struct usb_req req = { CMD_MEM_RD, mbox, sizeof(wbuf), wbuf, len, val };
 144
 145         return af9035_ctrl_msg(d, &req);
 146 }
 147
 148 /* write single register */
 149 static int af9035_wr_reg(struct dvb_usb_device *d, u32 reg, u8 val)
 150 {
 151         return af9035_wr_regs(d, reg, &val, 1);
 152 }
 153
 154 /* read single register */
 155 static int af9035_rd_reg(struct dvb_usb_device *d, u32 reg, u8 *val)
 156 {
 157         return af9035_rd_regs(d, reg, val, 1);
 158 }
 159
 160 /* write single register with mask */
 161 static int af9035_wr_reg_mask(struct dvb_usb_device *d, u32 reg, u8 val,
 162                 u8 mask)
 163 {
 164         int ret;
 165         u8 tmp;
 166
 167         /* no need for read if whole reg is written */
 168         if (mask != 0xff) {
 169                 ret = af9035_rd_regs(d, reg, &tmp, 1);
 170                 if (ret)
 171                         return ret;
 172
 173                 val &= mask;
 174                 tmp &= ~mask;
 175                 val |= tmp;
 176         }
 177
 178         return af9035_wr_regs(d, reg, &val, 1);
 179 }
 180
 181 static int af9035_i2c_master_xfer(struct i2c_adapter *adap,
 182                 struct i2c_msg msg[], int num)
 183 {
 184         struct dvb_usb_device *d = i2c_get_adapdata(adap);
 185         struct state *state = d_to_priv(d);
 186         int ret;
 187
 188         if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
 189                 return -EAGAIN;
 190
 191         /*
 192          * I2C sub header is 5 bytes long. Meaning of those bytes are:
 193          * 0: data len
 194          * 1: I2C addr << 1
 195          * 2: reg addr len
 196          *    byte 3 and 4 can be used as reg addr
 197          * 3: reg addr MSB
 198          *    used when reg addr len is set to 2
 199          * 4: reg addr LSB
 200          *    used when reg addr len is set to 1 or 2
 201          *
 202          * For the simplify we do not use register addr at all.
 203          * NOTE: As a firmware knows tuner type there is very small possibility
 204          * there could be some tuner I2C hacks done by firmware and this may
 205          * lead problems if firmware expects those bytes are used.
 206          */
 207         if (num == 2 && !(msg[0].flags & I2C_M_RD) &&
 208                         (msg[1].flags & I2C_M_RD)) {
 209                 if (msg[0].len > 40 || msg[1].len > 40) {
 210                         /* TODO: correct limits > 40 */
 211                         ret = -EOPNOTSUPP;
 212                 } else if ((msg[0].addr == state->af9033_config[0].i2c_addr) ||
 213                            (msg[0].addr == state->af9033_config[1].i2c_addr)) {
 214                         /* demod access via firmware interface */
 215                         u32 reg = msg[0].buf[0] << 16 | msg[0].buf[1] << 8 |
 216                                         msg[0].buf[2];
 217
 218                         if (msg[0].addr == state->af9033_config[1].i2c_addr)
 219                                 reg |= 0x100000;
 220
 221                         ret = af9035_rd_regs(d, reg, &msg[1].buf[0],
 222                                         msg[1].len);
 223                 } else {
 224                         /* I2C */
 225                         u8 buf[5 + msg[0].len];
 226                         struct usb_req req = { CMD_I2C_RD, 0, sizeof(buf),
 227                                         buf, msg[1].len, msg[1].buf };
 228                         req.mbox |= ((msg[0].addr & 0x80)  >>  3);
 229                         buf[0] = msg[1].len;
 230                         buf[1] = msg[0].addr << 1;
 231                         buf[2] = 0x00; /* reg addr len */
 232                         buf[3] = 0x00; /* reg addr MSB */
 233                         buf[4] = 0x00; /* reg addr LSB */
 234                         memcpy(&buf[5], msg[0].buf, msg[0].len);
 235                         ret = af9035_ctrl_msg(d, &req);
 236                 }
 237         } else if (num == 1 && !(msg[0].flags & I2C_M_RD)) {
 238                 if (msg[0].len > 40) {
 239                         /* TODO: correct limits > 40 */
 240                         ret = -EOPNOTSUPP;
 241                 } else if ((msg[0].addr == state->af9033_config[0].i2c_addr) ||
 242                            (msg[0].addr == state->af9033_config[1].i2c_addr)) {
 243                         /* demod access via firmware interface */
 244                         u32 reg = msg[0].buf[0] << 16 | msg[0].buf[1] << 8 |
 245                                         msg[0].buf[2];
 246
 247                         if (msg[0].addr == state->af9033_config[1].i2c_addr)
 248                                 reg |= 0x100000;
 249
 250                         ret = af9035_wr_regs(d, reg, &msg[0].buf[3],
 251                                         msg[0].len - 3);
 252                 } else {
 253                         /* I2C */
 254                         u8 buf[5 + msg[0].len];
 255                         struct usb_req req = { CMD_I2C_WR, 0, sizeof(buf), buf,
 256                                         0, NULL };
 257                         req.mbox |= ((msg[0].addr & 0x80)  >>  3);
 258                         buf[0] = msg[0].len;
 259                         buf[1] = msg[0].addr << 1;
 260                         buf[2] = 0x00; /* reg addr len */
 261                         buf[3] = 0x00; /* reg addr MSB */
 262                         buf[4] = 0x00; /* reg addr LSB */
 263                         memcpy(&buf[5], msg[0].buf, msg[0].len);
 264                         ret = af9035_ctrl_msg(d, &req);
 265                 }
 266         } else {
 267                 /*
 268                  * We support only two kind of I2C transactions:
 269                  * 1) 1 x read + 1 x write
 270                  * 2) 1 x write
 271                  */
 272                 ret = -EOPNOTSUPP;
 273         }
 274
 275         mutex_unlock(&d->i2c_mutex);
 276
 277         if (ret < 0)
 278                 return ret;
 279         else
 280                 return num;
 281 }
 282
 283 static u32 af9035_i2c_functionality(struct i2c_adapter *adapter)
 284 {
 285         return I2C_FUNC_I2C;
 286 }
 287
 288 static struct i2c_algorithm af9035_i2c_algo = {
 289         .master_xfer = af9035_i2c_master_xfer,
 290         .functionality = af9035_i2c_functionality,
 291 };
 292
 293 static int af9035_identify_state(struct dvb_usb_device *d, const char **name)
 294 {
 295         struct state *state = d_to_priv(d);
 296         int ret;
 297         u8 wbuf[1] = { 1 };
 298         u8 rbuf[4];
 299         struct usb_req req = { CMD_FW_QUERYINFO, 0, sizeof(wbuf), wbuf,
 300                         sizeof(rbuf), rbuf };
 301
 302         ret = af9035_rd_regs(d, 0x1222, rbuf, 3);
 303         if (ret < 0)
 304                 goto err;
 305
 306         state->chip_version = rbuf[0];
 307         state->chip_type = rbuf[2] << 8 | rbuf[1] << 0;
 308
 309         ret = af9035_rd_reg(d, 0x384f, &state->prechip_version);
 310         if (ret < 0)
 311                 goto err;
 312
 313         dev_info(&d->udev->dev,
 314                         "%s: prechip_version=%02x chip_version=%02x chip_type=%04x\n",
 315                         __func__, state->prechip_version, state->chip_version,
 316                         state->chip_type);
 317
 318         if (state->chip_type == 0x9135) {
 319                 if (state->chip_version == 2)
 320                         *name = AF9035_FIRMWARE_IT9135_V2;
 321                 else
 322                         *name = AF9035_FIRMWARE_IT9135_V1;
 323         } else {
 324                 *name = AF9035_FIRMWARE_AF9035;
 325         }
 326
 327         ret = af9035_ctrl_msg(d, &req);
 328         if (ret < 0)
 329                 goto err;
 330
 331         dev_dbg(&d->udev->dev, "%s: reply=%*ph\n", __func__, 4, rbuf);
 332         if (rbuf[0] || rbuf[1] || rbuf[2] || rbuf[3])
 333                 ret = WARM;
 334         else
 335                 ret = COLD;
 336
 337         return ret;
 338
 339 err:
 340         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
 341
 342         return ret;
 343 }
 344
 345 static int af9035_download_firmware_af9035(struct dvb_usb_device *d,
 346                 const struct firmware *fw)
 347 {
 348         int ret, i, j, len;
 349         u8 wbuf[1];
 350         u8 rbuf[4];
 351         struct usb_req req = { 0, 0, 0, NULL, 0, NULL };
 352         struct usb_req req_fw_dl = { CMD_FW_DL, 0, 0, wbuf, 0, NULL };
 353         struct usb_req req_fw_ver = { CMD_FW_QUERYINFO, 0, 1, wbuf, 4, rbuf } ;
 354         u8 hdr_core, tmp;
 355         u16 hdr_addr, hdr_data_len, hdr_checksum;
 356         #define MAX_DATA 58
 357         #define HDR_SIZE 7
 358
 359         /*
 360          * In case of dual tuner configuration we need to do some extra
 361          * initialization in order to download firmware to slave demod too,
 362          * which is done by master demod.
 363          * Master feeds also clock and controls power via GPIO.
 364          */
 365         ret = af9035_rd_reg(d, EEPROM_DUAL_MODE, &tmp);
 366         if (ret < 0)
 367                 goto err;
 368
 369         if (tmp) {
 370                 /* configure gpioh1, reset & power slave demod */
 371                 ret = af9035_wr_reg_mask(d, 0x00d8b0, 0x01, 0x01);
 372                 if (ret < 0)
 373                         goto err;
 374
 375                 ret = af9035_wr_reg_mask(d, 0x00d8b1, 0x01, 0x01);
 376                 if (ret < 0)
 377                         goto err;
 378
 379                 ret = af9035_wr_reg_mask(d, 0x00d8af, 0x00, 0x01);
 380                 if (ret < 0)
 381                         goto err;
 382
 383                 usleep_range(10000, 50000);
 384
 385                 ret = af9035_wr_reg_mask(d, 0x00d8af, 0x01, 0x01);
 386                 if (ret < 0)
 387                         goto err;
 388
 389                 /* tell the slave I2C address */
 390                 ret = af9035_rd_reg(d, EEPROM_2ND_DEMOD_ADDR, &tmp);
 391                 if (ret < 0)
 392                         goto err;
 393
 394                 ret = af9035_wr_reg(d, 0x00417f, tmp);
 395                 if (ret < 0)
 396                         goto err;
 397
 398                 /* enable clock out */
 399                 ret = af9035_wr_reg_mask(d, 0x00d81a, 0x01, 0x01);
 400                 if (ret < 0)
 401                         goto err;
 402         }
 403
 404         /*
 405          * Thanks to Daniel Glöckner <daniel-gl@gmx.net> about that info!
 406          *
 407          * byte 0: MCS 51 core
 408          *  There are two inside the AF9035 (1=Link and 2=OFDM) with separate
 409          *  address spaces
 410          * byte 1-2: Big endian destination address
 411          * byte 3-4: Big endian number of data bytes following the header
 412          * byte 5-6: Big endian header checksum, apparently ignored by the chip
 413          *  Calculated as ~(h[0]*256+h[1]+h[2]*256+h[3]+h[4]*256)
 414          */
 415
 416         for (i = fw->size; i > HDR_SIZE;) {
 417                 hdr_core = fw->data[fw->size - i + 0];
 418                 hdr_addr = fw->data[fw->size - i + 1] << 8;
 419                 hdr_addr |= fw->data[fw->size - i + 2] << 0;
 420                 hdr_data_len = fw->data[fw->size - i + 3] << 8;
 421                 hdr_data_len |= fw->data[fw->size - i + 4] << 0;
 422                 hdr_checksum = fw->data[fw->size - i + 5] << 8;
 423                 hdr_checksum |= fw->data[fw->size - i + 6] << 0;
 424
 425                 dev_dbg(&d->udev->dev, "%s: core=%d addr=%04x data_len=%d " \
 426                                 "checksum=%04x\n", __func__, hdr_core, hdr_addr,
 427                                 hdr_data_len, hdr_checksum);
 428
 429                 if (((hdr_core != 1) && (hdr_core != 2)) ||
 430                                 (hdr_data_len > i)) {
 431                         dev_dbg(&d->udev->dev, "%s: bad firmware\n", __func__);
 432                         break;
 433                 }
 434
 435                 /* download begin packet */
 436                 req.cmd = CMD_FW_DL_BEGIN;
 437                 ret = af9035_ctrl_msg(d, &req);
 438                 if (ret < 0)
 439                         goto err;
 440
 441                 /* download firmware packet(s) */
 442                 for (j = HDR_SIZE + hdr_data_len; j > 0; j -= MAX_DATA) {
 443                         len = j;
 444                         if (len > MAX_DATA)
 445                                 len = MAX_DATA;
 446                         req_fw_dl.wlen = len;
 447                         req_fw_dl.wbuf = (u8 *) &fw->data[fw->size - i +
 448                                         HDR_SIZE + hdr_data_len - j];
 449                         ret = af9035_ctrl_msg(d, &req_fw_dl);
 450                         if (ret < 0)
 451                                 goto err;
 452                 }
 453
 454                 /* download end packet */
 455                 req.cmd = CMD_FW_DL_END;
 456                 ret = af9035_ctrl_msg(d, &req);
 457                 if (ret < 0)
 458                         goto err;
 459
 460                 i -= hdr_data_len + HDR_SIZE;
 461
 462                 dev_dbg(&d->udev->dev, "%s: data uploaded=%zu\n",
 463                                 __func__, fw->size - i);
 464         }
 465
 466         /* print warn if firmware is bad, continue and see what happens */
 467         if (i)
 468                 dev_warn(&d->udev->dev, "%s: bad firmware\n", KBUILD_MODNAME);
 469
 470         /* firmware loaded, request boot */
 471         req.cmd = CMD_FW_BOOT;
 472         ret = af9035_ctrl_msg(d, &req);
 473         if (ret < 0)
 474                 goto err;
 475
 476         /* ensure firmware starts */
 477         wbuf[0] = 1;
 478         ret = af9035_ctrl_msg(d, &req_fw_ver);
 479         if (ret < 0)
 480                 goto err;
 481
 482         if (!(rbuf[0] || rbuf[1] || rbuf[2] || rbuf[3])) {
 483                 dev_err(&d->udev->dev, "%s: firmware did not run\n",
 484                                 KBUILD_MODNAME);
 485                 ret = -ENODEV;
 486                 goto err;
 487         }
 488
 489         dev_info(&d->udev->dev, "%s: firmware version=%d.%d.%d.%d",
 490                         KBUILD_MODNAME, rbuf[0], rbuf[1], rbuf[2], rbuf[3]);
 491
 492         return 0;
 493
 494 err:
 495         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
 496
 497         return ret;
 498 }
 499
 500 static int af9035_download_firmware_it9135(struct dvb_usb_device *d,
 501                 const struct firmware *fw)
 502 {
 503         int ret, i, i_prev;
 504         u8 wbuf[1];
 505         u8 rbuf[4];
 506         struct usb_req req = { 0, 0, 0, NULL, 0, NULL };
 507         struct usb_req req_fw_dl = { CMD_FW_SCATTER_WR, 0, 0, NULL, 0, NULL };
 508         struct usb_req req_fw_ver = { CMD_FW_QUERYINFO, 0, 1, wbuf, 4, rbuf } ;
 509         #define HDR_SIZE 7
 510
 511         /*
 512          * There seems to be following firmware header. Meaning of bytes 0-3
 513          * is unknown.
 514          *
 515          * 0: 3
 516          * 1: 0, 1
 517          * 2: 0
 518          * 3: 1, 2, 3
 519          * 4: addr MSB
 520          * 5: addr LSB
 521          * 6: count of data bytes ?
 522          */
 523
 524         for (i = HDR_SIZE, i_prev = 0; i <= fw->size; i++) {
 525                 if (i == fw->size ||
 526                                 (fw->data[i + 0] == 0x03 &&
 527                                 (fw->data[i + 1] == 0x00 ||
 528                                 fw->data[i + 1] == 0x01) &&
 529                                 fw->data[i + 2] == 0x00)) {
 530                         req_fw_dl.wlen = i - i_prev;
 531                         req_fw_dl.wbuf = (u8 *) &fw->data[i_prev];
 532                         i_prev = i;
 533                         ret = af9035_ctrl_msg(d, &req_fw_dl);
 534                         if (ret < 0)
 535                                 goto err;
 536
 537                         dev_dbg(&d->udev->dev, "%s: data uploaded=%d\n",
 538                                         __func__, i);
 539                 }
 540         }
 541
 542         /* firmware loaded, request boot */
 543         req.cmd = CMD_FW_BOOT;
 544         ret = af9035_ctrl_msg(d, &req);
 545         if (ret < 0)
 546                 goto err;
 547
 548         /* ensure firmware starts */
 549         wbuf[0] = 1;
 550         ret = af9035_ctrl_msg(d, &req_fw_ver);
 551         if (ret < 0)
 552                 goto err;
 553
 554         if (!(rbuf[0] || rbuf[1] || rbuf[2] || rbuf[3])) {
 555                 dev_err(&d->udev->dev, "%s: firmware did not run\n",
 556                                 KBUILD_MODNAME);
 557                 ret = -ENODEV;
 558                 goto err;
 559         }
 560
 561         dev_info(&d->udev->dev, "%s: firmware version=%d.%d.%d.%d",
 562                         KBUILD_MODNAME, rbuf[0], rbuf[1], rbuf[2], rbuf[3]);
 563
 564         return 0;
 565
 566 err:
 567         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
 568
 569         return ret;
 570 }
 571
 572 static int af9035_download_firmware(struct dvb_usb_device *d,
 573                 const struct firmware *fw)
 574 {
 575         struct state *state = d_to_priv(d);
 576
 577         if (state->chip_type == 0x9135)
 578                 return af9035_download_firmware_it9135(d, fw);
 579         else
 580                 return af9035_download_firmware_af9035(d, fw);
 581 }
 582
 583 static int af9035_read_config_af9035(struct dvb_usb_device *d)
 584 {
 585         struct state *state = d_to_priv(d);
 586         int ret, i, eeprom_shift = 0;
 587         u8 tmp;
 588         u16 tmp16;
 589
 590         /* demod I2C "address" */
 591         state->af9033_config[0].i2c_addr = 0x38;
 592         state->af9033_config[0].adc_multiplier = AF9033_ADC_MULTIPLIER_2X;
 593
 594         /* check if there is dual tuners */
 595         ret = af9035_rd_reg(d, EEPROM_DUAL_MODE, &tmp);
 596         if (ret < 0)
 597                 goto err;
 598
 599         state->dual_mode = tmp;
 600         dev_dbg(&d->udev->dev, "%s: dual mode=%d\n", __func__,
 601                         state->dual_mode);
 602
 603         if (state->dual_mode) {
 604                 /* read 2nd demodulator I2C address */
 605                 ret = af9035_rd_reg(d, EEPROM_2ND_DEMOD_ADDR, &tmp);
 606                 if (ret < 0)
 607                         goto err;
 608
 609                 state->af9033_config[1].i2c_addr = tmp;
 610                 dev_dbg(&d->udev->dev, "%s: 2nd demod I2C addr=%02x\n",
 611                                 __func__, tmp);
 612         }
 613
 614         for (i = 0; i < state->dual_mode + 1; i++) {
 615                 /* tuner */
 616                 ret = af9035_rd_reg(d, EEPROM_1_TUNER_ID + eeprom_shift, &tmp);
 617                 if (ret < 0)
 618                         goto err;
 619
 620                 state->af9033_config[i].tuner = tmp;
 621                 dev_dbg(&d->udev->dev, "%s: [%d]tuner=%02x\n",
 622                                 __func__, i, tmp);
 623
 624                 switch (tmp) {
 625                 case AF9033_TUNER_TUA9001:
 626                 case AF9033_TUNER_FC0011:
 627                 case AF9033_TUNER_MXL5007T:
 628                 case AF9033_TUNER_TDA18218:
 629                 case AF9033_TUNER_FC2580:
 630                 case AF9033_TUNER_FC0012:
 631                         state->af9033_config[i].spec_inv = 1;
 632                         break;
 633                 default:
 634                         dev_warn(&d->udev->dev, "%s: tuner id=%02x not " \
 635                                         "supported, please report!",
 636                                         KBUILD_MODNAME, tmp);
 637                 }
 638
 639                 /* disable dual mode if driver does not support it */
 640                 if (i == 1)
 641                         switch (tmp) {
 642                         case AF9033_TUNER_FC0012:
 643                                 break;
 644                         default:
 645                                 state->dual_mode = false;
 646                                 dev_info(&d->udev->dev, "%s: driver does not " \
 647                                                 "support 2nd tuner and will " \
 648                                                 "disable it", KBUILD_MODNAME);
 649                 }
 650
 651                 /* tuner IF frequency */
 652                 ret = af9035_rd_reg(d, EEPROM_1_IFFREQ_L + eeprom_shift, &tmp);
 653                 if (ret < 0)
 654                         goto err;
 655
 656                 tmp16 = tmp;
 657
 658                 ret = af9035_rd_reg(d, EEPROM_1_IFFREQ_H + eeprom_shift, &tmp);
 659                 if (ret < 0)
 660                         goto err;
 661
 662                 tmp16 |= tmp << 8;
 663
 664                 dev_dbg(&d->udev->dev, "%s: [%d]IF=%d\n", __func__, i, tmp16);
 665
 666                 eeprom_shift = 0x10; /* shift for the 2nd tuner params */
 667         }
 668
 669         /* get demod clock */
 670         ret = af9035_rd_reg(d, 0x00d800, &tmp);
 671         if (ret < 0)
 672                 goto err;
 673
 674         tmp = (tmp >> 0) & 0x0f;
 675
 676         for (i = 0; i < ARRAY_SIZE(state->af9033_config); i++)
 677                 state->af9033_config[i].clock = clock_lut[tmp];
 678
 679         return 0;
 680
 681 err:
 682         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
 683
 684         return ret;
 685 }
 686
 687 static int af9035_read_config_it9135(struct dvb_usb_device *d)
 688 {
 689         struct state *state = d_to_priv(d);
 690         int ret, i;
 691         u8 tmp;
 692
 693         /* demod I2C "address" */
 694         state->af9033_config[0].i2c_addr = 0x38;
 695         state->af9033_config[0].tuner = AF9033_TUNER_IT9135_38;
 696         state->af9033_config[0].adc_multiplier = AF9033_ADC_MULTIPLIER_2X;
 697         state->dual_mode = false;
 698
 699         /* check if eeprom exists */
 700         if (state->chip_version == 2)
 701                 ret = af9035_rd_reg(d, 0x00461d, &tmp);
 702         else
 703                 ret = af9035_rd_reg(d, 0x00461b, &tmp);
 704         if (ret < 0)
 705                 goto err;
 706
 707         if (tmp) {
 708                 /* tuner */
 709                 ret = af9035_rd_reg(d, 0x0049d0, &tmp);
 710                 if (ret < 0)
 711                         goto err;
 712
 713                 dev_dbg(&d->udev->dev, "%s: [%d]tuner=%02x\n",
 714                                 __func__, 0, tmp);
 715
 716                 if (tmp)
 717                         state->af9033_config[0].tuner = tmp;
 718         }
 719
 720         /* get demod clock */
 721         ret = af9035_rd_reg(d, 0x00d800, &tmp);
 722         if (ret < 0)
 723                 goto err;
 724
 725         tmp = (tmp >> 0) & 0x0f;
 726
 727         for (i = 0; i < ARRAY_SIZE(state->af9033_config); i++)
 728                 state->af9033_config[i].clock = clock_lut_it9135[tmp];
 729
 730         return 0;
 731
 732 err:
 733         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
 734
 735         return ret;
 736 }
 737
 738 static int af9035_read_config(struct dvb_usb_device *d)
 739 {
 740         struct state *state = d_to_priv(d);
 741
 742         if (state->chip_type == 0x9135)
 743                 return af9035_read_config_it9135(d);
 744         else
 745                 return af9035_read_config_af9035(d);
 746 }
 747
 748 static int af9035_tua9001_tuner_callback(struct dvb_usb_device *d,
 749                 int cmd, int arg)
 750 {
 751         int ret;
 752         u8 val;
 753
 754         dev_dbg(&d->udev->dev, "%s: cmd=%d arg=%d\n", __func__, cmd, arg);
 755
 756         /*
 757          * CEN     always enabled by hardware wiring
 758          * RESETN  GPIOT3
 759          * RXEN    GPIOT2
 760          */
 761
 762         switch (cmd) {
 763         case TUA9001_CMD_RESETN:
 764                 if (arg)
 765                         val = 0x00;
 766                 else
 767                         val = 0x01;
 768
 769                 ret = af9035_wr_reg_mask(d, 0x00d8e7, val, 0x01);
 770                 if (ret < 0)
 771                         goto err;
 772                 break;
 773         case TUA9001_CMD_RXEN:
 774                 if (arg)
 775                         val = 0x01;
 776                 else
 777                         val = 0x00;
 778
 779                 ret = af9035_wr_reg_mask(d, 0x00d8eb, val, 0x01);
 780                 if (ret < 0)
 781                         goto err;
 782                 break;
 783         }
 784
 785         return 0;
 786
 787 err:
 788         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
 789
 790         return ret;
 791 }
 792
 793
 794 static int af9035_fc0011_tuner_callback(struct dvb_usb_device *d,
 795                 int cmd, int arg)
 796 {
 797         int ret;
 798
 799         switch (cmd) {
 800         case FC0011_FE_CALLBACK_POWER:
 801                 /* Tuner enable */
 802                 ret = af9035_wr_reg_mask(d, 0xd8eb, 1, 1);
 803                 if (ret < 0)
 804                         goto err;
 805
 806                 ret = af9035_wr_reg_mask(d, 0xd8ec, 1, 1);
 807                 if (ret < 0)
 808                         goto err;
 809
 810                 ret = af9035_wr_reg_mask(d, 0xd8ed, 1, 1);
 811                 if (ret < 0)
 812                         goto err;
 813
 814                 /* LED */
 815                 ret = af9035_wr_reg_mask(d, 0xd8d0, 1, 1);
 816                 if (ret < 0)
 817                         goto err;
 818
 819                 ret = af9035_wr_reg_mask(d, 0xd8d1, 1, 1);
 820                 if (ret < 0)
 821                         goto err;
 822
 823                 usleep_range(10000, 50000);
 824                 break;
 825         case FC0011_FE_CALLBACK_RESET:
 826                 ret = af9035_wr_reg(d, 0xd8e9, 1);
 827                 if (ret < 0)
 828                         goto err;
 829
 830                 ret = af9035_wr_reg(d, 0xd8e8, 1);
 831                 if (ret < 0)
 832                         goto err;
 833
 834                 ret = af9035_wr_reg(d, 0xd8e7, 1);
 835                 if (ret < 0)
 836                         goto err;
 837
 838                 usleep_range(10000, 20000);
 839
 840                 ret = af9035_wr_reg(d, 0xd8e7, 0);
 841                 if (ret < 0)
 842                         goto err;
 843
 844                 usleep_range(10000, 20000);
 845                 break;
 846         default:
 847                 ret = -EINVAL;
 848                 goto err;
 849         }
 850
 851         return 0;
 852
 853 err:
 854         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
 855
 856         return ret;
 857 }
 858
 859 static int af9035_tuner_callback(struct dvb_usb_device *d, int cmd, int arg)
 860 {
 861         struct state *state = d_to_priv(d);
 862
 863         switch (state->af9033_config[0].tuner) {
 864         case AF9033_TUNER_FC0011:
 865                 return af9035_fc0011_tuner_callback(d, cmd, arg);
 866         case AF9033_TUNER_TUA9001:
 867                 return af9035_tua9001_tuner_callback(d, cmd, arg);
 868         default:
 869                 break;
 870         }
 871
 872         return 0;
 873 }
 874
 875 static int af9035_frontend_callback(void *adapter_priv, int component,
 876                                     int cmd, int arg)
 877 {
 878         struct i2c_adapter *adap = adapter_priv;
 879         struct dvb_usb_device *d = i2c_get_adapdata(adap);
 880
 881         dev_dbg(&d->udev->dev, "%s: component=%d cmd=%d arg=%d\n",
 882                         __func__, component, cmd, arg);
 883
 884         switch (component) {
 885         case DVB_FRONTEND_COMPONENT_TUNER:
 886                 return af9035_tuner_callback(d, cmd, arg);
 887         default:
 888                 break;
 889         }
 890
 891         return 0;
 892 }
 893
 894 static int af9035_get_adapter_count(struct dvb_usb_device *d)
 895 {
 896         struct state *state = d_to_priv(d);
 897
 898         /* disable 2nd adapter as we don't have PID filters implemented */
 899         if (d->udev->speed == USB_SPEED_FULL)
 900                 return 1;
 901         else
 902                 return state->dual_mode + 1;
 903 }
 904
 905 static int af9035_frontend_attach(struct dvb_usb_adapter *adap)
 906 {
 907         struct state *state = adap_to_priv(adap);
 908         struct dvb_usb_device *d = adap_to_d(adap);
 909         int ret;
 910
 911         if (!state->af9033_config[adap->id].tuner) {
 912                 /* unsupported tuner */
 913                 ret = -ENODEV;
 914                 goto err;
 915         }
 916
 917         if (adap->id == 0) {
 918                 state->af9033_config[0].ts_mode = AF9033_TS_MODE_USB;
 919                 state->af9033_config[1].ts_mode = AF9033_TS_MODE_SERIAL;
 920
 921                 ret = af9035_wr_reg(d, 0x00417f,
 922                                 state->af9033_config[1].i2c_addr);
 923                 if (ret < 0)
 924                         goto err;
 925
 926                 ret = af9035_wr_reg(d, 0x00d81a, state->dual_mode);
 927                 if (ret < 0)
 928                         goto err;
 929         }
 930
 931         /* attach demodulator */
 932         adap->fe[0] = dvb_attach(af9033_attach, &state->af9033_config[adap->id],
 933                         &d->i2c_adap);
 934         if (adap->fe[0] == NULL) {
 935                 ret = -ENODEV;
 936                 goto err;
 937         }
 938
 939         /* disable I2C-gate */
 940         adap->fe[0]->ops.i2c_gate_ctrl = NULL;
 941         adap->fe[0]->callback = af9035_frontend_callback;
 942
 943         return 0;
 944
 945 err:
 946         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
 947
 948         return ret;
 949 }
 950
 951 static struct tua9001_config af9035_tua9001_config = {
 952         .i2c_addr = 0x60,
 953 };
 954
 955 static const struct fc0011_config af9035_fc0011_config = {
 956         .i2c_address = 0x60,
 957 };
 958
 959 static struct mxl5007t_config af9035_mxl5007t_config[] = {
 960         {
 961                 .xtal_freq_hz = MxL_XTAL_24_MHZ,
 962                 .if_freq_hz = MxL_IF_4_57_MHZ,
 963                 .invert_if = 0,
 964                 .loop_thru_enable = 0,
 965                 .clk_out_enable = 0,
 966                 .clk_out_amp = MxL_CLKOUT_AMP_0_94V,
 967         }, {
 968                 .xtal_freq_hz = MxL_XTAL_24_MHZ,
 969                 .if_freq_hz = MxL_IF_4_57_MHZ,
 970                 .invert_if = 0,
 971                 .loop_thru_enable = 1,
 972                 .clk_out_enable = 1,
 973                 .clk_out_amp = MxL_CLKOUT_AMP_0_94V,
 974         }
 975 };
 976
 977 static struct tda18218_config af9035_tda18218_config = {
 978         .i2c_address = 0x60,
 979         .i2c_wr_max = 21,
 980 };
 981
 982 static const struct fc2580_config af9035_fc2580_config = {
 983         .i2c_addr = 0x56,
 984         .clock = 16384000,
 985 };
 986
 987 static const struct fc0012_config af9035_fc0012_config[] = {
 988         {
 989                 .i2c_address = 0x63,
 990                 .xtal_freq = FC_XTAL_36_MHZ,
 991                 .dual_master = true,
 992                 .loop_through = true,
 993                 .clock_out = true,
 994         }, {
 995                 .i2c_address = 0x63 | 0x80, /* I2C bus select hack */
 996                 .xtal_freq = FC_XTAL_36_MHZ,
 997                 .dual_master = true,
 998         }
 999 };
1000
1001 static struct ite_config af9035_it913x_config = {
1002         .chip_ver = 0x01,
1003         .chip_type = 0x9135,
1004         .firmware = 0x00000000,
1005         .firmware_ver = 1,
1006         .adc_x2 = 1,
1007         .tuner_id_0 = AF9033_TUNER_IT9135_38,
1008         .tuner_id_1 = 0x00,
1009         .dual_mode = 0x00,
1010         .adf = 0x00,
1011         /* option to read SIGNAL_LEVEL */
1012         .read_slevel = 0,
1013 };
1014
1015 static int af9035_tuner_attach(struct dvb_usb_adapter *adap)
1016 {
1017         struct state *state = adap_to_priv(adap);
1018         struct dvb_usb_device *d = adap_to_d(adap);
1019         int ret;
1020         struct dvb_frontend *fe;
1021         struct i2c_msg msg[1];
1022         u8 tuner_addr;
1023         /*
1024          * XXX: Hack used in that function: we abuse unused I2C address bit [7]
1025          * to carry info about used I2C bus for dual tuner configuration.
1026          */
1027
1028         switch (state->af9033_config[adap->id].tuner) {
1029         case AF9033_TUNER_TUA9001:
1030                 /* AF9035 gpiot3 = TUA9001 RESETN
1031                    AF9035 gpiot2 = TUA9001 RXEN */
1032
1033                 /* configure gpiot2 and gpiot2 as output */
1034                 ret = af9035_wr_reg_mask(d, 0x00d8ec, 0x01, 0x01);
1035                 if (ret < 0)
1036                         goto err;
1037
1038                 ret = af9035_wr_reg_mask(d, 0x00d8ed, 0x01, 0x01);
1039                 if (ret < 0)
1040                         goto err;
1041
1042                 ret = af9035_wr_reg_mask(d, 0x00d8e8, 0x01, 0x01);
1043                 if (ret < 0)
1044                         goto err;
1045
1046                 ret = af9035_wr_reg_mask(d, 0x00d8e9, 0x01, 0x01);
1047                 if (ret < 0)
1048                         goto err;
1049
1050                 /* attach tuner */
1051                 fe = dvb_attach(tua9001_attach, adap->fe[0],
1052                                 &d->i2c_adap, &af9035_tua9001_config);
1053                 break;
1054         case AF9033_TUNER_FC0011:
1055                 fe = dvb_attach(fc0011_attach, adap->fe[0],
1056                                 &d->i2c_adap, &af9035_fc0011_config);
1057                 break;
1058         case AF9033_TUNER_MXL5007T:
1059                 if (adap->id == 0) {
1060                         ret = af9035_wr_reg(d, 0x00d8e0, 1);
1061                         if (ret < 0)
1062                                 goto err;
1063
1064                         ret = af9035_wr_reg(d, 0x00d8e1, 1);
1065                         if (ret < 0)
1066                                 goto err;
1067
1068                         ret = af9035_wr_reg(d, 0x00d8df, 0);
1069                         if (ret < 0)
1070                                 goto err;
1071
1072                         msleep(30);
1073
1074                         ret = af9035_wr_reg(d, 0x00d8df, 1);
1075                         if (ret < 0)
1076                                 goto err;
1077
1078                         msleep(300);
1079
1080                         ret = af9035_wr_reg(d, 0x00d8c0, 1);
1081                         if (ret < 0)
1082                                 goto err;
1083
1084                         ret = af9035_wr_reg(d, 0x00d8c1, 1);
1085                         if (ret < 0)
1086                                 goto err;
1087
1088                         ret = af9035_wr_reg(d, 0x00d8bf, 0);
1089                         if (ret < 0)
1090                                 goto err;
1091
1092                         ret = af9035_wr_reg(d, 0x00d8b4, 1);
1093                         if (ret < 0)
1094                                 goto err;
1095
1096                         ret = af9035_wr_reg(d, 0x00d8b5, 1);
1097                         if (ret < 0)
1098                                 goto err;
1099
1100                         ret = af9035_wr_reg(d, 0x00d8b3, 1);
1101                         if (ret < 0)
1102                                 goto err;
1103
1104                         tuner_addr = 0x60;
1105                 } else {
1106                         tuner_addr = 0x60 | 0x80; /* I2C bus hack */
1107                 }
1108
1109                 /* attach tuner */
1110                 fe = dvb_attach(mxl5007t_attach, adap->fe[0], &d->i2c_adap,
1111                                 tuner_addr, &af9035_mxl5007t_config[adap->id]);
1112                 break;
1113         case AF9033_TUNER_TDA18218:
1114                 /* attach tuner */
1115                 fe = dvb_attach(tda18218_attach, adap->fe[0],
1116                                 &d->i2c_adap, &af9035_tda18218_config);
1117                 break;
1118         case AF9033_TUNER_FC2580:
1119                 /* Tuner enable using gpiot2_o, gpiot2_en and gpiot2_on  */
1120                 ret = af9035_wr_reg_mask(d, 0xd8eb, 0x01, 0x01);
1121                 if (ret < 0)
1122                         goto err;
1123
1124                 ret = af9035_wr_reg_mask(d, 0xd8ec, 0x01, 0x01);
1125                 if (ret < 0)
1126                         goto err;
1127
1128                 ret = af9035_wr_reg_mask(d, 0xd8ed, 0x01, 0x01);
1129                 if (ret < 0)
1130                         goto err;
1131
1132                 usleep_range(10000, 50000);
1133                 /* attach tuner */
1134                 fe = dvb_attach(fc2580_attach, adap->fe[0],
1135                                 &d->i2c_adap, &af9035_fc2580_config);
1136                 break;
1137         case AF9033_TUNER_FC0012:
1138                 /*
1139                  * AF9035 gpiot2 = FC0012 enable
1140                  * XXX: there seems to be something on gpioh8 too, but on my
1141                  * my test I didn't find any difference.
1142                  */
1143
1144                 if (adap->id == 0) {
1145                         /* configure gpiot2 as output and high */
1146                         ret = af9035_wr_reg_mask(d, 0xd8eb, 0x01, 0x01);
1147                         if (ret < 0)
1148                                 goto err;
1149
1150                         ret = af9035_wr_reg_mask(d, 0xd8ec, 0x01, 0x01);
1151                         if (ret < 0)
1152                                 goto err;
1153
1154                         ret = af9035_wr_reg_mask(d, 0xd8ed, 0x01, 0x01);
1155                         if (ret < 0)
1156                                 goto err;
1157                 } else {
1158                         /*
1159                          * FIXME: That belongs for the FC0012 driver.
1160                          * Write 02 to FC0012 master tuner register 0d directly
1161                          * in order to make slave tuner working.
1162                          */
1163                         msg[0].addr = 0x63;
1164                         msg[0].flags = 0;
1165                         msg[0].len = 2;
1166                         msg[0].buf = "\x0d\x02";
1167                         ret = i2c_transfer(&d->i2c_adap, msg, 1);
1168                         if (ret < 0)
1169                                 goto err;
1170                 }
1171
1172                 usleep_range(10000, 50000);
1173
1174                 fe = dvb_attach(fc0012_attach, adap->fe[0], &d->i2c_adap,
1175                                 &af9035_fc0012_config[adap->id]);
1176                 break;
1177         case AF9033_TUNER_IT9135_38:
1178         case AF9033_TUNER_IT9135_51:
1179         case AF9033_TUNER_IT9135_52:
1180         case AF9033_TUNER_IT9135_60:
1181         case AF9033_TUNER_IT9135_61:
1182         case AF9033_TUNER_IT9135_62:
1183                 /* attach tuner */
1184                 af9035_it913x_config.tuner_id_0 = state->af9033_config[0].tuner;
1185                 fe = dvb_attach(it913x_attach, adap->fe[0],
1186                                 &d->i2c_adap, 0x38, &af9035_it913x_config);
1187                 break;
1188         default:
1189                 fe = NULL;
1190         }
1191
1192         if (fe == NULL) {
1193                 ret = -ENODEV;
1194                 goto err;
1195         }
1196
1197         return 0;
1198
1199 err:
1200         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
1201
1202         return ret;
1203 }
1204
1205 static int af9035_init(struct dvb_usb_device *d)
1206 {
1207         struct state *state = d_to_priv(d);
1208         int ret, i;
1209         u16 frame_size = (d->udev->speed == USB_SPEED_FULL ? 5 : 87) * 188 / 4;
1210         u8 packet_size = (d->udev->speed == USB_SPEED_FULL ? 64 : 512) / 4;
1211         struct reg_val_mask tab[] = {
1212                 { 0x80f99d, 0x01, 0x01 },
1213                 { 0x80f9a4, 0x01, 0x01 },
1214                 { 0x00dd11, 0x00, 0x20 },
1215                 { 0x00dd11, 0x00, 0x40 },
1216                 { 0x00dd13, 0x00, 0x20 },
1217                 { 0x00dd13, 0x00, 0x40 },
1218                 { 0x00dd11, 0x20, 0x20 },
1219                 { 0x00dd88, (frame_size >> 0) & 0xff, 0xff},
1220                 { 0x00dd89, (frame_size >> 8) & 0xff, 0xff},
1221                 { 0x00dd0c, packet_size, 0xff},
1222                 { 0x00dd11, state->dual_mode << 6, 0x40 },
1223                 { 0x00dd8a, (frame_size >> 0) & 0xff, 0xff},
1224                 { 0x00dd8b, (frame_size >> 8) & 0xff, 0xff},
1225                 { 0x00dd0d, packet_size, 0xff },
1226                 { 0x80f9a3, state->dual_mode, 0x01 },
1227                 { 0x80f9cd, state->dual_mode, 0x01 },
1228                 { 0x80f99d, 0x00, 0x01 },
1229                 { 0x80f9a4, 0x00, 0x01 },
1230         };
1231
1232         dev_dbg(&d->udev->dev, "%s: USB speed=%d frame_size=%04x " \
1233                         "packet_size=%02x\n", __func__,
1234                         d->udev->speed, frame_size, packet_size);
1235
1236         /* init endpoints */
1237         for (i = 0; i < ARRAY_SIZE(tab); i++) {
1238                 ret = af9035_wr_reg_mask(d, tab[i].reg, tab[i].val,
1239                                 tab[i].mask);
1240                 if (ret < 0)
1241                         goto err;
1242         }
1243
1244         return 0;
1245
1246 err:
1247         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
1248
1249         return ret;
1250 }
1251
1252 #if IS_ENABLED(CONFIG_RC_CORE)
1253 static int af9035_rc_query(struct dvb_usb_device *d)
1254 {
1255         unsigned int key;
1256         unsigned char b[4];
1257         int ret;
1258         struct usb_req req = { CMD_IR_GET, 0, 0, NULL, 4, b };
1259
1260         ret = af9035_ctrl_msg(d, &req);
1261         if (ret < 0)
1262                 goto err;
1263
1264         if ((b[2] + b[3]) == 0xff) {
1265                 if ((b[0] + b[1]) == 0xff) {
1266                         /* NEC */
1267                         key = b[0] << 8 | b[2];
1268                 } else {
1269                         /* ext. NEC */
1270                         key = b[0] << 16 | b[1] << 8 | b[2];
1271                 }
1272         } else {
1273                 key = b[0] << 24 | b[1] << 16 | b[2] << 8 | b[3];
1274         }
1275
1276         rc_keydown(d->rc_dev, key, 0);
1277
1278 err:
1279         /* ignore errors */
1280         return 0;
1281 }
1282
1283 static int af9035_get_rc_config(struct dvb_usb_device *d, struct dvb_usb_rc *rc)
1284 {
1285         struct state *state = d_to_priv(d);
1286         int ret;
1287         u8 tmp;
1288
1289         /* TODO: IT9135 remote control support */
1290         if (state->chip_type == 0x9135)
1291                 return 0;
1292
1293         ret = af9035_rd_reg(d, EEPROM_IR_MODE, &tmp);
1294         if (ret < 0)
1295                 goto err;
1296
1297         dev_dbg(&d->udev->dev, "%s: ir_mode=%02x\n", __func__, tmp);
1298
1299         /* don't activate rc if in HID mode or if not available */
1300         if (tmp == 5) {
1301                 ret = af9035_rd_reg(d, EEPROM_IR_TYPE, &tmp);
1302                 if (ret < 0)
1303                         goto err;
1304
1305                 dev_dbg(&d->udev->dev, "%s: ir_type=%02x\n", __func__, tmp);
1306
1307                 switch (tmp) {
1308                 case 0: /* NEC */
1309                 default:
1310                         rc->allowed_protos = RC_BIT_NEC;
1311                         break;
1312                 case 1: /* RC6 */
1313                         rc->allowed_protos = RC_BIT_RC6_MCE;
1314                         break;
1315                 }
1316
1317                 rc->query = af9035_rc_query;
1318                 rc->interval = 500;
1319
1320                 /* load empty to enable rc */
1321                 if (!rc->map_name)
1322                         rc->map_name = RC_MAP_EMPTY;
1323         }
1324
1325         return 0;
1326
1327 err:
1328         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
1329
1330         return ret;
1331 }
1332 #else
1333         #define af9035_get_rc_config NULL
1334 #endif
1335
1336 static int af9035_get_stream_config(struct dvb_frontend *fe, u8 *ts_type,
1337                 struct usb_data_stream_properties *stream)
1338 {
1339         struct dvb_usb_device *d = fe_to_d(fe);
1340         dev_dbg(&d->udev->dev, "%s: adap=%d\n", __func__, fe_to_adap(fe)->id);
1341
1342         if (d->udev->speed == USB_SPEED_FULL)
1343                 stream->u.bulk.buffersize = 5 * 188;
1344
1345         return 0;
1346 }
1347
1348 /*
1349  * FIXME: PID filter is property of demodulator and should be moved to the
1350  * correct driver. Also we support only adapter #0 PID filter and will
1351  * disable adapter #1 if USB1.1 is used.
1352  */
1353 static int af9035_pid_filter_ctrl(struct dvb_usb_adapter *adap, int onoff)
1354 {
1355         struct dvb_usb_device *d = adap_to_d(adap);
1356         int ret;
1357
1358         dev_dbg(&d->udev->dev, "%s: onoff=%d\n", __func__, onoff);
1359
1360         ret = af9035_wr_reg_mask(d, 0x80f993, onoff, 0x01);
1361         if (ret < 0)
1362                 goto err;
1363
1364         return 0;
1365
1366 err:
1367         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
1368
1369         return ret;
1370 }
1371
1372 static int af9035_pid_filter(struct dvb_usb_adapter *adap, int index, u16 pid,
1373                 int onoff)
1374 {
1375         struct dvb_usb_device *d = adap_to_d(adap);
1376         int ret;
1377         u8 wbuf[2] = {(pid >> 0) & 0xff, (pid >> 8) & 0xff};
1378
1379         dev_dbg(&d->udev->dev, "%s: index=%d pid=%04x onoff=%d\n",
1380                         __func__, index, pid, onoff);
1381
1382         ret = af9035_wr_regs(d, 0x80f996, wbuf, 2);
1383         if (ret < 0)
1384                 goto err;
1385
1386         ret = af9035_wr_reg(d, 0x80f994, onoff);
1387         if (ret < 0)
1388                 goto err;
1389
1390         ret = af9035_wr_reg(d, 0x80f995, index);
1391         if (ret < 0)
1392                 goto err;
1393
1394         return 0;
1395
1396 err:
1397         dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
1398
1399         return ret;
1400 }
1401
1402 static int af9035_probe(struct usb_interface *intf,
1403                 const struct usb_device_id *id)
1404 {
1405         struct usb_device *udev = interface_to_usbdev(intf);
1406         char manufacturer[sizeof("Afatech")];
1407
1408         memset(manufacturer, 0, sizeof(manufacturer));
1409         usb_string(udev, udev->descriptor.iManufacturer,
1410                         manufacturer, sizeof(manufacturer));
1411         /*
1412          * There is two devices having same ID but different chipset. One uses
1413          * AF9015 and the other IT9135 chipset. Only difference seen on lsusb
1414          * is iManufacturer string.
1415          *
1416          * idVendor           0x0ccd TerraTec Electronic GmbH
1417          * idProduct          0x0099
1418          * bcdDevice            2.00
1419          * iManufacturer           1 Afatech
1420          * iProduct                2 DVB-T 2
1421          *
1422          * idVendor           0x0ccd TerraTec Electronic GmbH
1423          * idProduct          0x0099
1424          * bcdDevice            2.00
1425          * iManufacturer           1 ITE Technologies, Inc.
1426          * iProduct                2 DVB-T TV Stick
1427          */
1428         if ((le16_to_cpu(udev->descriptor.idVendor) == USB_VID_TERRATEC) &&
1429                         (le16_to_cpu(udev->descriptor.idProduct) == 0x0099)) {
1430                 if (!strcmp("Afatech", manufacturer)) {
1431                         dev_dbg(&udev->dev, "%s: rejecting device\n", __func__);
1432                         return -ENODEV;
1433                 }
1434         }
1435
1436         return dvb_usbv2_probe(intf, id);
1437 }
1438
1439 /* interface 0 is used by DVB-T receiver and
1440    interface 1 is for remote controller (HID) */
1441 static const struct dvb_usb_device_properties af9035_props = {
1442         .driver_name = KBUILD_MODNAME,
1443         .owner = THIS_MODULE,
1444         .adapter_nr = adapter_nr,
1445         .size_of_priv = sizeof(struct state),
1446
1447         .generic_bulk_ctrl_endpoint = 0x02,
1448         .generic_bulk_ctrl_endpoint_response = 0x81,
1449
1450         .identify_state = af9035_identify_state,
1451         .download_firmware = af9035_download_firmware,
1452
1453         .i2c_algo = &af9035_i2c_algo,
1454         .read_config = af9035_read_config,
1455         .frontend_attach = af9035_frontend_attach,
1456         .tuner_attach = af9035_tuner_attach,
1457         .init = af9035_init,
1458         .get_rc_config = af9035_get_rc_config,
1459         .get_stream_config = af9035_get_stream_config,
1460
1461         .get_adapter_count = af9035_get_adapter_count,
1462         .adapter = {
1463                 {
1464                         .caps = DVB_USB_ADAP_HAS_PID_FILTER |
1465                                 DVB_USB_ADAP_PID_FILTER_CAN_BE_TURNED_OFF,
1466
1467                         .pid_filter_count = 32,
1468                         .pid_filter_ctrl = af9035_pid_filter_ctrl,
1469                         .pid_filter = af9035_pid_filter,
1470
1471                         .stream = DVB_USB_STREAM_BULK(0x84, 6, 87 * 188),
1472                 }, {
1473                         .stream = DVB_USB_STREAM_BULK(0x85, 6, 87 * 188),
1474                 },
1475         },
1476 };
1477
1478 static const struct usb_device_id af9035_id_table[] = {
1479         { DVB_USB_DEVICE(USB_VID_AFATECH, USB_PID_AFATECH_AF9035_9035,
1480                 &af9035_props, "Afatech AF9035 reference design", NULL) },
1481         { DVB_USB_DEVICE(USB_VID_AFATECH, USB_PID_AFATECH_AF9035_1000,
1482                 &af9035_props, "Afatech AF9035 reference design", NULL) },
1483         { DVB_USB_DEVICE(USB_VID_AFATECH, USB_PID_AFATECH_AF9035_1001,
1484                 &af9035_props, "Afatech AF9035 reference design", NULL) },
1485         { DVB_USB_DEVICE(USB_VID_AFATECH, USB_PID_AFATECH_AF9035_1002,
1486                 &af9035_props, "Afatech AF9035 reference design", NULL) },
1487         { DVB_USB_DEVICE(USB_VID_AFATECH, USB_PID_AFATECH_AF9035_1003,
1488                 &af9035_props, "Afatech AF9035 reference design", NULL) },
1489         { DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_CINERGY_T_STICK,
1490                 &af9035_props, "TerraTec Cinergy T Stick", NULL) },
1491         { DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_A835,
1492                 &af9035_props, "AVerMedia AVerTV Volar HD/PRO (A835)", NULL) },
1493         { DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_B835,
1494                 &af9035_props, "AVerMedia AVerTV Volar HD/PRO (A835)", NULL) },
1495         { DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_1867,
1496                 &af9035_props, "AVerMedia HD Volar (A867)", NULL) },
1497         { DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_A867,
1498                 &af9035_props, "AVerMedia HD Volar (A867)", NULL) },
1499         { DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_TWINSTAR,
1500                 &af9035_props, "AVerMedia Twinstar (A825)", NULL) },
1501         { DVB_USB_DEVICE(USB_VID_ASUS, USB_PID_ASUS_U3100MINI_PLUS,
1502                 &af9035_props, "Asus U3100Mini Plus", NULL) },
1503         { DVB_USB_DEVICE(USB_VID_TERRATEC, 0x00aa,
1504                 &af9035_props, "TerraTec Cinergy T Stick (rev. 2)", NULL) },
1505         /* XXX: that same ID [0ccd:0099] is used by af9015 driver too */
1506         { DVB_USB_DEVICE(USB_VID_TERRATEC, 0x0099,
1507                 &af9035_props, "TerraTec Cinergy T Stick Dual RC (rev. 2)", NULL) },
1508         { }
1509 };
1510 MODULE_DEVICE_TABLE(usb, af9035_id_table);
1511
1512 static struct usb_driver af9035_usb_driver = {
1513         .name = KBUILD_MODNAME,
1514         .id_table = af9035_id_table,
1515         .probe = af9035_probe,
1516         .disconnect = dvb_usbv2_disconnect,
1517         .suspend = dvb_usbv2_suspend,
1518         .resume = dvb_usbv2_resume,
1519         .reset_resume = dvb_usbv2_reset_resume,
1520         .no_dynamic_id = 1,
1521         .soft_unbind = 1,
1522 };
1523
1524 module_usb_driver(af9035_usb_driver);
1525
1526 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
1527 MODULE_DESCRIPTION("Afatech AF9035 driver");
1528 MODULE_LICENSE("GPL");
1529 MODULE_FIRMWARE(AF9035_FIRMWARE_AF9035);
1530 MODULE_FIRMWARE(AF9035_FIRMWARE_IT9135_V1);
1531 MODULE_FIRMWARE(AF9035_FIRMWARE_IT9135_V2);