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

   1 /* Linux driver for devices based on the DiBcom DiB0700 USB bridge
   2  *
   3  *      This program is free software; you can redistribute it and/or modify it
   4  *      under the terms of the GNU General Public License as published by the Free
   5  *      Software Foundation, version 2.
   6  *
   7  *  Copyright (C) 2005-6 DiBcom, SA
   8  */
   9 #include "dib0700.h"
  10
  11 /* debug */
  12 int dvb_usb_dib0700_debug;
  13 module_param_named(debug,dvb_usb_dib0700_debug, int, 0644);
  14 MODULE_PARM_DESC(debug, "set debugging level (1=info,2=fw,4=fwdata,8=data (or-able))." DVB_USB_DEBUG_STATUS);
  15
  16 static int nb_packet_buffer_size = 21;
  17 module_param(nb_packet_buffer_size, int, 0644);
  18 MODULE_PARM_DESC(nb_packet_buffer_size,
  19         "Set the dib0700 driver data buffer size. This parameter "
  20         "corresponds to the number of TS packets. The actual size of "
  21         "the data buffer corresponds to this parameter "
  22         "multiplied by 188 (default: 21)");
  23
  24 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
  25
  26
  27 int dib0700_get_version(struct dvb_usb_device *d, u32 *hwversion,
  28                         u32 *romversion, u32 *ramversion, u32 *fwtype)
  29 {
  30         u8 b[16];
  31         int ret = usb_control_msg(d->udev, usb_rcvctrlpipe(d->udev, 0),
  32                                   REQUEST_GET_VERSION,
  33                                   USB_TYPE_VENDOR | USB_DIR_IN, 0, 0,
  34                                   b, sizeof(b), USB_CTRL_GET_TIMEOUT);
  35         if (hwversion != NULL)
  36                 *hwversion  = (b[0] << 24)  | (b[1] << 16)  | (b[2] << 8)  | b[3];
  37         if (romversion != NULL)
  38                 *romversion = (b[4] << 24)  | (b[5] << 16)  | (b[6] << 8)  | b[7];
  39         if (ramversion != NULL)
  40                 *ramversion = (b[8] << 24)  | (b[9] << 16)  | (b[10] << 8) | b[11];
  41         if (fwtype != NULL)
  42                 *fwtype     = (b[12] << 24) | (b[13] << 16) | (b[14] << 8) | b[15];
  43         return ret;
  44 }
  45
  46 /* expecting rx buffer: request data[0] data[1] ... data[2] */
  47 static int dib0700_ctrl_wr(struct dvb_usb_device *d, u8 *tx, u8 txlen)
  48 {
  49         int status;
  50
  51         deb_data(">>> ");
  52         debug_dump(tx, txlen, deb_data);
  53
  54         status = usb_control_msg(d->udev, usb_sndctrlpipe(d->udev,0),
  55                 tx[0], USB_TYPE_VENDOR | USB_DIR_OUT, 0, 0, tx, txlen,
  56                 USB_CTRL_GET_TIMEOUT);
  57
  58         if (status != txlen)
  59                 deb_data("ep 0 write error (status = %d, len: %d)\n",status,txlen);
  60
  61         return status < 0 ? status : 0;
  62 }
  63
  64 /* expecting tx buffer: request data[0] ... data[n] (n <= 4) */
  65 int dib0700_ctrl_rd(struct dvb_usb_device *d, u8 *tx, u8 txlen, u8 *rx, u8 rxlen)
  66 {
  67         u16 index, value;
  68         int status;
  69
  70         if (txlen < 2) {
  71                 err("tx buffer length is smaller than 2. Makes no sense.");
  72                 return -EINVAL;
  73         }
  74         if (txlen > 4) {
  75                 err("tx buffer length is larger than 4. Not supported.");
  76                 return -EINVAL;
  77         }
  78
  79         deb_data(">>> ");
  80         debug_dump(tx,txlen,deb_data);
  81
  82         value = ((txlen - 2) << 8) | tx[1];
  83         index = 0;
  84         if (txlen > 2)
  85                 index |= (tx[2] << 8);
  86         if (txlen > 3)
  87                 index |= tx[3];
  88
  89         status = usb_control_msg(d->udev, usb_rcvctrlpipe(d->udev,0), tx[0],
  90                         USB_TYPE_VENDOR | USB_DIR_IN, value, index, rx, rxlen,
  91                         USB_CTRL_GET_TIMEOUT);
  92
  93         if (status < 0)
  94                 deb_info("ep 0 read error (status = %d)\n",status);
  95
  96         deb_data("<<< ");
  97         debug_dump(rx, rxlen, deb_data);
  98
  99         return status; /* length in case of success */
 100 }
 101
 102 int dib0700_set_gpio(struct dvb_usb_device *d, enum dib07x0_gpios gpio, u8 gpio_dir, u8 gpio_val)
 103 {
 104         u8 buf[3] = { REQUEST_SET_GPIO, gpio, ((gpio_dir & 0x01) << 7) | ((gpio_val & 0x01) << 6) };
 105         return dib0700_ctrl_wr(d, buf, sizeof(buf));
 106 }
 107
 108 static int dib0700_set_usb_xfer_len(struct dvb_usb_device *d, u16 nb_ts_packets)
 109 {
 110         struct dib0700_state *st = d->priv;
 111         u8 b[3];
 112         int ret;
 113
 114         if (st->fw_version >= 0x10201) {
 115                 b[0] = REQUEST_SET_USB_XFER_LEN;
 116                 b[1] = (nb_ts_packets >> 8) & 0xff;
 117                 b[2] = nb_ts_packets & 0xff;
 118
 119                 deb_info("set the USB xfer len to %i Ts packet\n", nb_ts_packets);
 120
 121                 ret = dib0700_ctrl_wr(d, b, sizeof(b));
 122         } else {
 123                 deb_info("this firmware does not allow to change the USB xfer len\n");
 124                 ret = -EIO;
 125         }
 126
 127         return ret;
 128 }
 129
 130 /*
 131  * I2C master xfer function (supported in 1.20 firmware)
 132  */
 133 static int dib0700_i2c_xfer_new(struct i2c_adapter *adap, struct i2c_msg *msg,
 134                                 int num)
 135 {
 136         /* The new i2c firmware messages are more reliable and in particular
 137            properly support i2c read calls not preceded by a write */
 138
 139         struct dvb_usb_device *d = i2c_get_adapdata(adap);
 140         uint8_t bus_mode = 1;  /* 0=eeprom bus, 1=frontend bus */
 141         uint8_t gen_mode = 0; /* 0=master i2c, 1=gpio i2c */
 142         uint8_t en_start = 0;
 143         uint8_t en_stop = 0;
 144         uint8_t buf[255]; /* TBV: malloc ? */
 145         int result, i;
 146
 147         /* Ensure nobody else hits the i2c bus while we're sending our
 148            sequence of messages, (such as the remote control thread) */
 149         if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
 150                 return -EAGAIN;
 151
 152         for (i = 0; i < num; i++) {
 153                 if (i == 0) {
 154                         /* First message in the transaction */
 155                         en_start = 1;
 156                 } else if (!(msg[i].flags & I2C_M_NOSTART)) {
 157                         /* Device supports repeated-start */
 158                         en_start = 1;
 159                 } else {
 160                         /* Not the first packet and device doesn't support
 161                            repeated start */
 162                         en_start = 0;
 163                 }
 164                 if (i == (num - 1)) {
 165                         /* Last message in the transaction */
 166                         en_stop = 1;
 167                 }
 168
 169                 if (msg[i].flags & I2C_M_RD) {
 170                         /* Read request */
 171                         u16 index, value;
 172                         uint8_t i2c_dest;
 173
 174                         i2c_dest = (msg[i].addr << 1);
 175                         value = ((en_start << 7) | (en_stop << 6) |
 176                                  (msg[i].len & 0x3F)) << 8 | i2c_dest;
 177                         /* I2C ctrl + FE bus; */
 178                         index = ((gen_mode << 6) & 0xC0) |
 179                                 ((bus_mode << 4) & 0x30);
 180
 181                         result = usb_control_msg(d->udev,
 182                                                  usb_rcvctrlpipe(d->udev, 0),
 183                                                  REQUEST_NEW_I2C_READ,
 184                                                  USB_TYPE_VENDOR | USB_DIR_IN,
 185                                                  value, index, msg[i].buf,
 186                                                  msg[i].len,
 187                                                  USB_CTRL_GET_TIMEOUT);
 188                         if (result < 0) {
 189                                 err("i2c read error (status = %d)\n", result);
 190                                 break;
 191                         }
 192
 193                         deb_data("<<< ");
 194                         debug_dump(msg[i].buf, msg[i].len, deb_data);
 195
 196                 } else {
 197                         /* Write request */
 198                         buf[0] = REQUEST_NEW_I2C_WRITE;
 199                         buf[1] = msg[i].addr << 1;
 200                         buf[2] = (en_start << 7) | (en_stop << 6) |
 201                                 (msg[i].len & 0x3F);
 202                         /* I2C ctrl + FE bus; */
 203                         buf[3] = ((gen_mode << 6) & 0xC0) |
 204                                  ((bus_mode << 4) & 0x30);
 205                         /* The Actual i2c payload */
 206                         memcpy(&buf[4], msg[i].buf, msg[i].len);
 207
 208                         deb_data(">>> ");
 209                         debug_dump(buf, msg[i].len + 4, deb_data);
 210
 211                         result = usb_control_msg(d->udev,
 212                                                  usb_sndctrlpipe(d->udev, 0),
 213                                                  REQUEST_NEW_I2C_WRITE,
 214                                                  USB_TYPE_VENDOR | USB_DIR_OUT,
 215                                                  0, 0, buf, msg[i].len + 4,
 216                                                  USB_CTRL_GET_TIMEOUT);
 217                         if (result < 0) {
 218                                 err("i2c write error (status = %d)\n", result);
 219                                 break;
 220                         }
 221                 }
 222         }
 223         mutex_unlock(&d->i2c_mutex);
 224         return i;
 225 }
 226
 227 /*
 228  * I2C master xfer function (pre-1.20 firmware)
 229  */
 230 static int dib0700_i2c_xfer_legacy(struct i2c_adapter *adap,
 231                                    struct i2c_msg *msg, int num)
 232 {
 233         struct dvb_usb_device *d = i2c_get_adapdata(adap);
 234         int i,len;
 235         u8 buf[255];
 236
 237         if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
 238                 return -EAGAIN;
 239
 240         for (i = 0; i < num; i++) {
 241                 /* fill in the address */
 242                 buf[1] = msg[i].addr << 1;
 243                 /* fill the buffer */
 244                 memcpy(&buf[2], msg[i].buf, msg[i].len);
 245
 246                 /* write/read request */
 247                 if (i+1 < num && (msg[i+1].flags & I2C_M_RD)) {
 248                         buf[0] = REQUEST_I2C_READ;
 249                         buf[1] |= 1;
 250
 251                         /* special thing in the current firmware: when length is zero the read-failed */
 252                         if ((len = dib0700_ctrl_rd(d, buf, msg[i].len + 2, msg[i+1].buf, msg[i+1].len)) <= 0) {
 253                                 deb_info("I2C read failed on address 0x%02x\n",
 254                                          msg[i].addr);
 255                                 break;
 256                         }
 257
 258                         msg[i+1].len = len;
 259
 260                         i++;
 261                 } else {
 262                         buf[0] = REQUEST_I2C_WRITE;
 263                         if (dib0700_ctrl_wr(d, buf, msg[i].len + 2) < 0)
 264                                 break;
 265                 }
 266         }
 267
 268         mutex_unlock(&d->i2c_mutex);
 269         return i;
 270 }
 271
 272 static int dib0700_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msg,
 273                             int num)
 274 {
 275         struct dvb_usb_device *d = i2c_get_adapdata(adap);
 276         struct dib0700_state *st = d->priv;
 277
 278         if (st->fw_use_new_i2c_api == 1) {
 279                 /* User running at least fw 1.20 */
 280                 return dib0700_i2c_xfer_new(adap, msg, num);
 281         } else {
 282                 /* Use legacy calls */
 283                 return dib0700_i2c_xfer_legacy(adap, msg, num);
 284         }
 285 }
 286
 287 static u32 dib0700_i2c_func(struct i2c_adapter *adapter)
 288 {
 289         return I2C_FUNC_I2C;
 290 }
 291
 292 struct i2c_algorithm dib0700_i2c_algo = {
 293         .master_xfer   = dib0700_i2c_xfer,
 294         .functionality = dib0700_i2c_func,
 295 };
 296
 297 int dib0700_identify_state(struct usb_device *udev, struct dvb_usb_device_properties *props,
 298                         struct dvb_usb_device_description **desc, int *cold)
 299 {
 300         u8 b[16];
 301         s16 ret = usb_control_msg(udev, usb_rcvctrlpipe(udev,0),
 302                 REQUEST_GET_VERSION, USB_TYPE_VENDOR | USB_DIR_IN, 0, 0, b, 16, USB_CTRL_GET_TIMEOUT);
 303
 304         deb_info("FW GET_VERSION length: %d\n",ret);
 305
 306         *cold = ret <= 0;
 307
 308         deb_info("cold: %d\n", *cold);
 309         return 0;
 310 }
 311
 312 static int dib0700_set_clock(struct dvb_usb_device *d, u8 en_pll,
 313         u8 pll_src, u8 pll_range, u8 clock_gpio3, u16 pll_prediv,
 314         u16 pll_loopdiv, u16 free_div, u16 dsuScaler)
 315 {
 316         u8 b[10];
 317         b[0] = REQUEST_SET_CLOCK;
 318         b[1] = (en_pll << 7) | (pll_src << 6) | (pll_range << 5) | (clock_gpio3 << 4);
 319         b[2] = (pll_prediv >> 8)  & 0xff; // MSB
 320         b[3] =  pll_prediv        & 0xff; // LSB
 321         b[4] = (pll_loopdiv >> 8) & 0xff; // MSB
 322         b[5] =  pll_loopdiv       & 0xff; // LSB
 323         b[6] = (free_div >> 8)    & 0xff; // MSB
 324         b[7] =  free_div          & 0xff; // LSB
 325         b[8] = (dsuScaler >> 8)   & 0xff; // MSB
 326         b[9] =  dsuScaler         & 0xff; // LSB
 327
 328         return dib0700_ctrl_wr(d, b, 10);
 329 }
 330
 331 int dib0700_set_i2c_speed(struct dvb_usb_device *d, u16 scl_kHz)
 332 {
 333         u16 divider;
 334         u8 b[8];
 335
 336         if (scl_kHz == 0)
 337                 return -EINVAL;
 338
 339         b[0] = REQUEST_SET_I2C_PARAM;
 340         divider = (u16) (30000 / scl_kHz);
 341         b[2] = (u8) (divider >> 8);
 342         b[3] = (u8) (divider & 0xff);
 343         divider = (u16) (72000 / scl_kHz);
 344         b[4] = (u8) (divider >> 8);
 345         b[5] = (u8) (divider & 0xff);
 346         divider = (u16) (72000 / scl_kHz); /* clock: 72MHz */
 347         b[6] = (u8) (divider >> 8);
 348         b[7] = (u8) (divider & 0xff);
 349
 350         deb_info("setting I2C speed: %04x %04x %04x (%d kHz).", (b[2] << 8) | (b[3]), (b[4] << 8) | b[5], (b[6] << 8) | b[7], scl_kHz);
 351         return dib0700_ctrl_wr(d, b, 8);
 352 }
 353
 354
 355 int dib0700_ctrl_clock(struct dvb_usb_device *d, u32 clk_MHz, u8 clock_out_gp3)
 356 {
 357         switch (clk_MHz) {
 358                 case 72: dib0700_set_clock(d, 1, 0, 1, clock_out_gp3, 2, 24, 0, 0x4c); break;
 359                 default: return -EINVAL;
 360         }
 361         return 0;
 362 }
 363
 364 static int dib0700_jumpram(struct usb_device *udev, u32 address)
 365 {
 366         int ret, actlen;
 367         u8 buf[8] = { REQUEST_JUMPRAM, 0, 0, 0,
 368                 (address >> 24) & 0xff,
 369                 (address >> 16) & 0xff,
 370                 (address >> 8)  & 0xff,
 371                  address        & 0xff };
 372
 373         if ((ret = usb_bulk_msg(udev, usb_sndbulkpipe(udev, 0x01),buf,8,&actlen,1000)) < 0) {
 374                 deb_fw("jumpram to 0x%x failed\n",address);
 375                 return ret;
 376         }
 377         if (actlen != 8) {
 378                 deb_fw("jumpram to 0x%x failed\n",address);
 379                 return -EIO;
 380         }
 381         return 0;
 382 }
 383
 384 int dib0700_download_firmware(struct usb_device *udev, const struct firmware *fw)
 385 {
 386         struct hexline hx;
 387         int pos = 0, ret, act_len, i, adap_num;
 388         u8 b[16];
 389         u32 fw_version;
 390
 391         u8 buf[260];
 392
 393         while ((ret = dvb_usb_get_hexline(fw, &hx, &pos)) > 0) {
 394                 deb_fwdata("writing to address 0x%08x (buffer: 0x%02x %02x)\n",
 395                                 hx.addr, hx.len, hx.chk);
 396
 397                 buf[0] = hx.len;
 398                 buf[1] = (hx.addr >> 8) & 0xff;
 399                 buf[2] =  hx.addr       & 0xff;
 400                 buf[3] = hx.type;
 401                 memcpy(&buf[4],hx.data,hx.len);
 402                 buf[4+hx.len] = hx.chk;
 403
 404                 ret = usb_bulk_msg(udev,
 405                         usb_sndbulkpipe(udev, 0x01),
 406                         buf,
 407                         hx.len + 5,
 408                         &act_len,
 409                         1000);
 410
 411                 if (ret < 0) {
 412                         err("firmware download failed at %d with %d",pos,ret);
 413                         return ret;
 414                 }
 415         }
 416
 417         if (ret == 0) {
 418                 /* start the firmware */
 419                 if ((ret = dib0700_jumpram(udev, 0x70000000)) == 0) {
 420                         info("firmware started successfully.");
 421                         msleep(500);
 422                 }
 423         } else
 424                 ret = -EIO;
 425
 426         /* the number of ts packet has to be at least 1 */
 427         if (nb_packet_buffer_size < 1)
 428                 nb_packet_buffer_size = 1;
 429
 430         /* get the fimware version */
 431         usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
 432                                   REQUEST_GET_VERSION,
 433                                   USB_TYPE_VENDOR | USB_DIR_IN, 0, 0,
 434                                   b, sizeof(b), USB_CTRL_GET_TIMEOUT);
 435         fw_version = (b[8] << 24) | (b[9] << 16) | (b[10] << 8) | b[11];
 436
 437         /* set the buffer size - DVB-USB is allocating URB buffers
 438          * only after the firwmare download was successful */
 439         for (i = 0; i < dib0700_device_count; i++) {
 440                 for (adap_num = 0; adap_num < dib0700_devices[i].num_adapters;
 441                                 adap_num++) {
 442                         if (fw_version >= 0x10201) {
 443                                 dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize = 188*nb_packet_buffer_size;
 444                         } else {
 445                                 /* for fw version older than 1.20.1,
 446                                  * the buffersize has to be n times 512 */
 447                                 dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize = ((188*nb_packet_buffer_size+188/2)/512)*512;
 448                                 if (dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize < 512)
 449                                         dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize = 512;
 450                         }
 451                 }
 452         }
 453
 454         return ret;
 455 }
 456
 457 int dib0700_streaming_ctrl(struct dvb_usb_adapter *adap, int onoff)
 458 {
 459         struct dib0700_state *st = adap->dev->priv;
 460         u8 b[4];
 461         int ret;
 462
 463         if ((onoff != 0) && (st->fw_version >= 0x10201)) {
 464                 /* for firmware later than 1.20.1,
 465                  * the USB xfer length can be set  */
 466                 ret = dib0700_set_usb_xfer_len(adap->dev,
 467                         st->nb_packet_buffer_size);
 468                 if (ret < 0) {
 469                         deb_info("can not set the USB xfer len\n");
 470                         return ret;
 471                 }
 472         }
 473
 474         b[0] = REQUEST_ENABLE_VIDEO;
 475         b[1] = (onoff << 4) | 0x00; /* this bit gives a kind of command, rather than enabling something or not */
 476
 477         if (st->disable_streaming_master_mode == 1)
 478                 b[2] = 0x00;
 479         else
 480                 b[2] = 0x01 << 4; /* Master mode */
 481
 482         b[3] = 0x00;
 483
 484         deb_info("modifying (%d) streaming state for %d\n", onoff, adap->id);
 485
 486         st->channel_state &= ~0x3;
 487         if ((adap->stream.props.endpoint != 2) && (adap->stream.props.endpoint != 3)) {
 488                 deb_info("the endpoint number (%i) is not correct, use the adapter id instead", adap->stream.props.endpoint);
 489                 if (onoff)
 490                         st->channel_state |=    1 << (adap->id);
 491                 else
 492                         st->channel_state |=    1 << ~(adap->id);
 493         }
 494         else {
 495                 if (onoff)
 496                         st->channel_state |=    1 << (adap->stream.props.endpoint-2);
 497                 else
 498                         st->channel_state |=    1 << (3-adap->stream.props.endpoint);
 499         }
 500
 501         b[2] |= st->channel_state;
 502
 503         deb_info("data for streaming: %x %x\n", b[1], b[2]);
 504
 505         return dib0700_ctrl_wr(adap->dev, b, 4);
 506 }
 507
 508 int dib0700_change_protocol(struct rc_dev *rc, u64 rc_type)
 509 {
 510         struct dvb_usb_device *d = rc->priv;
 511         struct dib0700_state *st = d->priv;
 512         u8 rc_setup[3] = { REQUEST_SET_RC, 0, 0 };
 513         int new_proto, ret;
 514
 515         /* Set the IR mode */
 516         if (rc_type == RC_TYPE_RC5)
 517                 new_proto = 1;
 518         else if (rc_type == RC_TYPE_NEC)
 519                 new_proto = 0;
 520         else if (rc_type == RC_TYPE_RC6) {
 521                 if (st->fw_version < 0x10200)
 522                         return -EINVAL;
 523
 524                 new_proto = 2;
 525         } else
 526                 return -EINVAL;
 527
 528         rc_setup[1] = new_proto;
 529
 530         ret = dib0700_ctrl_wr(d, rc_setup, sizeof(rc_setup));
 531         if (ret < 0) {
 532                 err("ir protocol setup failed");
 533                 return ret;
 534         }
 535
 536         d->props.rc.core.protocol = rc_type;
 537
 538         return ret;
 539 }
 540
 541 /* Number of keypresses to ignore before start repeating */
 542 #define RC_REPEAT_DELAY_V1_20 10
 543
 544 /* This is the structure of the RC response packet starting in firmware 1.20 */
 545 struct dib0700_rc_response {
 546         u8 report_id;
 547         u8 data_state;
 548         union {
 549                 u16 system16;
 550                 struct {
 551                         u8 not_system;
 552                         u8 system;
 553                 };
 554         };
 555         u8 data;
 556         u8 not_data;
 557 };
 558 #define RC_MSG_SIZE_V1_20 6
 559
 560 static void dib0700_rc_urb_completion(struct urb *purb)
 561 {
 562         struct dvb_usb_device *d = purb->context;
 563         struct dib0700_state *st;
 564         struct dib0700_rc_response *poll_reply;
 565         u32 uninitialized_var(keycode);
 566         u8 toggle;
 567
 568         deb_info("%s()\n", __func__);
 569         if (d == NULL)
 570                 return;
 571
 572         if (d->rc_dev == NULL) {
 573                 /* This will occur if disable_rc_polling=1 */
 574                 usb_free_urb(purb);
 575                 return;
 576         }
 577
 578         st = d->priv;
 579         poll_reply = purb->transfer_buffer;
 580
 581         if (purb->status < 0) {
 582                 deb_info("discontinuing polling\n");
 583                 usb_free_urb(purb);
 584                 return;
 585         }
 586
 587         if (purb->actual_length != RC_MSG_SIZE_V1_20) {
 588                 deb_info("malformed rc msg size=%d\n", purb->actual_length);
 589                 goto resubmit;
 590         }
 591
 592         deb_data("IR ID = %02X state = %02X System = %02X %02X Cmd = %02X %02X (len %d)\n",
 593                  poll_reply->report_id, poll_reply->data_state,
 594                  poll_reply->system, poll_reply->not_system,
 595                  poll_reply->data, poll_reply->not_data,
 596                  purb->actual_length);
 597
 598         switch (d->props.rc.core.protocol) {
 599         case RC_TYPE_NEC:
 600                 toggle = 0;
 601
 602                 /* NEC protocol sends repeat code as 0 0 0 FF */
 603                 if ((poll_reply->system == 0x00) && (poll_reply->data == 0x00)
 604                     && (poll_reply->not_data == 0xff)) {
 605                         poll_reply->data_state = 2;
 606                         break;
 607                 }
 608
 609                 if ((poll_reply->system ^ poll_reply->not_system) != 0xff) {
 610                         deb_data("NEC extended protocol\n");
 611                         /* NEC extended code - 24 bits */
 612                         keycode = be16_to_cpu(poll_reply->system16) << 8 | poll_reply->data;
 613                 } else {
 614                         deb_data("NEC normal protocol\n");
 615                         /* normal NEC code - 16 bits */
 616                         keycode = poll_reply->system << 8 | poll_reply->data;
 617                 }
 618
 619                 break;
 620         default:
 621                 deb_data("RC5 protocol\n");
 622                 /* RC5 Protocol */
 623                 toggle = poll_reply->report_id;
 624                 keycode = poll_reply->system << 8 | poll_reply->data;
 625
 626                 break;
 627         }
 628
 629         if ((poll_reply->data + poll_reply->not_data) != 0xff) {
 630                 /* Key failed integrity check */
 631                 err("key failed integrity check: %04x %02x %02x",
 632                     poll_reply->system,
 633                     poll_reply->data, poll_reply->not_data);
 634                 goto resubmit;
 635         }
 636
 637         rc_keydown(d->rc_dev, keycode, toggle);
 638
 639 resubmit:
 640         /* Clean the buffer before we requeue */
 641         memset(purb->transfer_buffer, 0, RC_MSG_SIZE_V1_20);
 642
 643         /* Requeue URB */
 644         usb_submit_urb(purb, GFP_ATOMIC);
 645 }
 646
 647 int dib0700_rc_setup(struct dvb_usb_device *d)
 648 {
 649         struct dib0700_state *st = d->priv;
 650         struct urb *purb;
 651         int ret;
 652
 653         /* Poll-based. Don't initialize bulk mode */
 654         if (st->fw_version < 0x10200)
 655                 return 0;
 656
 657         /* Starting in firmware 1.20, the RC info is provided on a bulk pipe */
 658         purb = usb_alloc_urb(0, GFP_KERNEL);
 659         if (purb == NULL) {
 660                 err("rc usb alloc urb failed\n");
 661                 return -ENOMEM;
 662         }
 663
 664         purb->transfer_buffer = kzalloc(RC_MSG_SIZE_V1_20, GFP_KERNEL);
 665         if (purb->transfer_buffer == NULL) {
 666                 err("rc kzalloc failed\n");
 667                 usb_free_urb(purb);
 668                 return -ENOMEM;
 669         }
 670
 671         purb->status = -EINPROGRESS;
 672         usb_fill_bulk_urb(purb, d->udev, usb_rcvbulkpipe(d->udev, 1),
 673                           purb->transfer_buffer, RC_MSG_SIZE_V1_20,
 674                           dib0700_rc_urb_completion, d);
 675
 676         ret = usb_submit_urb(purb, GFP_ATOMIC);
 677         if (ret)
 678                 err("rc submit urb failed\n");
 679
 680         return ret;
 681 }
 682
 683 static int dib0700_probe(struct usb_interface *intf,
 684                 const struct usb_device_id *id)
 685 {
 686         int i;
 687         struct dvb_usb_device *dev;
 688
 689         for (i = 0; i < dib0700_device_count; i++)
 690                 if (dvb_usb_device_init(intf, &dib0700_devices[i], THIS_MODULE,
 691                     &dev, adapter_nr) == 0) {
 692                         struct dib0700_state *st = dev->priv;
 693                         u32 hwversion, romversion, fw_version, fwtype;
 694
 695                         dib0700_get_version(dev, &hwversion, &romversion,
 696                                 &fw_version, &fwtype);
 697
 698                         deb_info("Firmware version: %x, %d, 0x%x, %d\n",
 699                                 hwversion, romversion, fw_version, fwtype);
 700
 701                         st->fw_version = fw_version;
 702                         st->nb_packet_buffer_size = (u32)nb_packet_buffer_size;
 703
 704                         /* Disable polling mode on newer firmwares */
 705                         if (st->fw_version >= 0x10200)
 706                                 dev->props.rc.core.bulk_mode = true;
 707                         else
 708                                 dev->props.rc.core.bulk_mode = false;
 709
 710                         dib0700_rc_setup(dev);
 711
 712                         return 0;
 713                 }
 714
 715         return -ENODEV;
 716 }
 717
 718 static struct usb_driver dib0700_driver = {
 719         .name       = "dvb_usb_dib0700",
 720         .probe      = dib0700_probe,
 721         .disconnect = dvb_usb_device_exit,
 722         .id_table   = dib0700_usb_id_table,
 723 };
 724
 725 /* module stuff */
 726 static int __init dib0700_module_init(void)
 727 {
 728         int result;
 729         info("loaded with support for %d different device-types", dib0700_device_count);
 730         if ((result = usb_register(&dib0700_driver))) {
 731                 err("usb_register failed. Error number %d",result);
 732                 return result;
 733         }
 734
 735         return 0;
 736 }
 737
 738 static void __exit dib0700_module_exit(void)
 739 {
 740         /* deregister this driver from the USB subsystem */
 741         usb_deregister(&dib0700_driver);
 742 }
 743
 744 module_init (dib0700_module_init);
 745 module_exit (dib0700_module_exit);
 746
 747 MODULE_AUTHOR("Patrick Boettcher <pboettcher@dibcom.fr>");
 748 MODULE_DESCRIPTION("Driver for devices based on DiBcom DiB0700 - USB bridge");
 749 MODULE_VERSION("1.0");
 750 MODULE_LICENSE("GPL");