drivers/staging/tm6000/tm6000-cards.c

   1 /*
   2    tm6000-cards.c - driver for TM5600/TM6000 USB video capture devices
   3
   4    Copyright (C) 2006-2007 Mauro Carvalho Chehab <mchehab@infradead.org>
   5
   6    This program is free software; you can redistribute it and/or modify
   7    it under the terms of the GNU General Public License as published by
   8    the Free Software Foundation version 2
   9
  10    This program is distributed in the hope that it will be useful,
  11    but WITHOUT ANY WARRANTY; without even the implied warranty of
  12    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13    GNU General Public License for more details.
  14
  15    You should have received a copy of the GNU General Public License
  16    along with this program; if not, write to the Free Software
  17    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  18  */
  19
  20 #include <linux/init.h>
  21 #include <linux/module.h>
  22 #include <linux/pci.h>
  23 #include <linux/delay.h>
  24 #include <linux/i2c.h>
  25 #include <linux/usb.h>
  26 #include <linux/version.h>
  27 #include <media/v4l2-common.h>
  28 #include <media/tuner.h>
  29 #include <media/tvaudio.h>
  30 #include <media/i2c-addr.h>
  31
  32 #include "tm6000.h"
  33 #include "tm6000-regs.h"
  34 #include "tuner-xc2028.h"
  35 #include "xc5000.h"
  36
  37 #define TM6000_BOARD_UNKNOWN                    0
  38 #define TM5600_BOARD_GENERIC                    1
  39 #define TM6000_BOARD_GENERIC                    2
  40 #define TM6010_BOARD_GENERIC                    3
  41 #define TM5600_BOARD_10MOONS_UT821              4
  42 #define TM5600_BOARD_10MOONS_UT330              5
  43 #define TM6000_BOARD_ADSTECH_DUAL_TV            6
  44 #define TM6000_BOARD_FREECOM_AND_SIMILAR        7
  45 #define TM6000_BOARD_ADSTECH_MINI_DUAL_TV       8
  46 #define TM6010_BOARD_HAUPPAUGE_900H             9
  47 #define TM6010_BOARD_BEHOLD_WANDER              10
  48 #define TM6010_BOARD_BEHOLD_VOYAGER             11
  49 #define TM6010_BOARD_TERRATEC_CINERGY_HYBRID_XE 12
  50
  51 #define TM6000_MAXBOARDS        16
  52 static unsigned int card[]     = {[0 ... (TM6000_MAXBOARDS - 1)] = UNSET };
  53
  54 module_param_array(card,  int, NULL, 0444);
  55
  56 static unsigned long tm6000_devused;
  57
  58
  59 struct tm6000_board {
  60         char            *name;
  61
  62         struct tm6000_capabilities caps;
  63
  64         enum            tm6000_devtype type;    /* variant of the chipset */
  65         int             tuner_type;     /* type of the tuner */
  66         int             tuner_addr;     /* tuner address */
  67         int             demod_addr;     /* demodulator address */
  68         int             gpio_addr_tun_reset;    /* GPIO used for tuner reset */
  69 };
  70
  71 struct tm6000_board tm6000_boards[] = {
  72         [TM6000_BOARD_UNKNOWN] = {
  73                 .name         = "Unknown tm6000 video grabber",
  74                 .caps = {
  75                         .has_tuner    = 1,
  76                 },
  77                 .gpio_addr_tun_reset = TM6000_GPIO_1,
  78         },
  79         [TM5600_BOARD_GENERIC] = {
  80                 .name         = "Generic tm5600 board",
  81                 .type         = TM5600,
  82                 .tuner_type   = TUNER_XC2028,
  83                 .tuner_addr   = 0xc2 >> 1,
  84                 .caps = {
  85                         .has_tuner      = 1,
  86                 },
  87                 .gpio_addr_tun_reset = TM6000_GPIO_1,
  88         },
  89         [TM6000_BOARD_GENERIC] = {
  90                 .name         = "Generic tm6000 board",
  91                 .tuner_type   = TUNER_XC2028,
  92                 .tuner_addr   = 0xc2 >> 1,
  93                 .caps = {
  94                         .has_tuner      = 1,
  95                         .has_dvb        = 1,
  96                 },
  97                 .gpio_addr_tun_reset = TM6000_GPIO_1,
  98         },
  99         [TM6010_BOARD_GENERIC] = {
 100                 .name         = "Generic tm6010 board",
 101                 .type         = TM6010,
 102                 .tuner_type   = TUNER_XC2028,
 103                 .tuner_addr   = 0xc2 >> 1,
 104                 .caps = {
 105                         .has_tuner      = 1,
 106                         .has_dvb        = 1,
 107                 },
 108                 .gpio_addr_tun_reset = TM6010_GPIO_4,
 109         },
 110         [TM5600_BOARD_10MOONS_UT821] = {
 111                 .name         = "10Moons UT 821",
 112                 .tuner_type   = TUNER_XC2028,
 113                 .type         = TM5600,
 114                 .tuner_addr   = 0xc2 >> 1,
 115                 .caps = {
 116                         .has_tuner    = 1,
 117                         .has_eeprom   = 1,
 118                 },
 119                 .gpio_addr_tun_reset = TM6000_GPIO_1,
 120         },
 121         [TM5600_BOARD_10MOONS_UT330] = {
 122                 .name         = "10Moons UT 330",
 123                 .tuner_type   = TUNER_PHILIPS_FQ1216AME_MK4,
 124                 .tuner_addr   = 0xc8 >> 1,
 125                 .caps = {
 126                         .has_tuner    = 1,
 127                         .has_dvb      = 0,
 128                         .has_zl10353  = 0,
 129                         .has_eeprom   = 1,
 130                 },
 131         },
 132         [TM6000_BOARD_ADSTECH_DUAL_TV] = {
 133                 .name         = "ADSTECH Dual TV USB",
 134                 .tuner_type   = TUNER_XC2028,
 135                 .tuner_addr   = 0xc8 >> 1,
 136                 .caps = {
 137                         .has_tuner    = 1,
 138                         .has_tda9874  = 1,
 139                         .has_dvb      = 1,
 140                         .has_zl10353  = 1,
 141                         .has_eeprom   = 1,
 142                 },
 143         },
 144         [TM6000_BOARD_FREECOM_AND_SIMILAR] = {
 145                 .name         = "Freecom Hybrid Stick / Moka DVB-T Receiver Dual",
 146                 .tuner_type   = TUNER_XC2028, /* has a XC3028 */
 147                 .tuner_addr   = 0xc2 >> 1,
 148                 .demod_addr   = 0x1e >> 1,
 149                 .caps = {
 150                         .has_tuner    = 1,
 151                         .has_dvb      = 1,
 152                         .has_zl10353  = 1,
 153                         .has_eeprom   = 0,
 154                         .has_remote   = 1,
 155                 },
 156                 .gpio_addr_tun_reset = TM6000_GPIO_4,
 157         },
 158         [TM6000_BOARD_ADSTECH_MINI_DUAL_TV] = {
 159                 .name         = "ADSTECH Mini Dual TV USB",
 160                 .tuner_type   = TUNER_XC2028, /* has a XC3028 */
 161                 .tuner_addr   = 0xc8 >> 1,
 162                 .demod_addr   = 0x1e >> 1,
 163                 .caps = {
 164                         .has_tuner    = 1,
 165                         .has_dvb      = 1,
 166                         .has_zl10353  = 1,
 167                         .has_eeprom   = 0,
 168                 },
 169                 .gpio_addr_tun_reset = TM6000_GPIO_4,
 170         },
 171         [TM6010_BOARD_HAUPPAUGE_900H] = {
 172                 .name         = "Hauppauge HVR-900H",
 173                 .tuner_type   = TUNER_XC2028, /* has a XC3028 */
 174                 .tuner_addr   = 0xc2 >> 1,
 175                 .demod_addr   = 0x1e >> 1,
 176                 .type         = TM6010,
 177                 .caps = {
 178                         .has_tuner    = 1,
 179                         .has_dvb      = 1,
 180                         .has_zl10353  = 1,
 181                         .has_eeprom   = 1,
 182                 },
 183                 .gpio_addr_tun_reset = TM6000_GPIO_2,
 184         },
 185         [TM6010_BOARD_BEHOLD_WANDER] = {
 186                 .name         = "Beholder Wander DVB-T/TV/FM USB2.0",
 187                 .tuner_type   = TUNER_XC5000,
 188                 .tuner_addr   = 0xc2 >> 1,
 189                 .demod_addr   = 0x1e >> 1,
 190                 .type         = TM6010,
 191                 .caps = {
 192                         .has_tuner    = 1,
 193                         .has_dvb      = 1,
 194                         .has_zl10353  = 1,
 195                         .has_eeprom   = 1,
 196                         .has_remote   = 1,
 197                 },
 198                 .gpio_addr_tun_reset = TM6000_GPIO_2,
 199         },
 200         [TM6010_BOARD_BEHOLD_VOYAGER] = {
 201                 .name         = "Beholder Voyager TV/FM USB2.0",
 202                 .tuner_type   = TUNER_XC5000,
 203                 .tuner_addr   = 0xc2 >> 1,
 204                 .type         = TM6010,
 205                 .caps = {
 206                         .has_tuner    = 1,
 207                         .has_dvb      = 0,
 208                         .has_zl10353  = 0,
 209                         .has_eeprom   = 1,
 210                         .has_remote   = 1,
 211                 },
 212                 .gpio_addr_tun_reset = TM6000_GPIO_2,
 213         },
 214         [TM6010_BOARD_TERRATEC_CINERGY_HYBRID_XE] = {
 215                 .name         = "Terratec Cinergy Hybrid XE",
 216                 .tuner_type   = TUNER_XC2028, /* has a XC3028 */
 217                 .tuner_addr   = 0xc2 >> 1,
 218                 .demod_addr   = 0x1e >> 1,
 219                 .type         = TM6010,
 220                 .caps = {
 221                         .has_tuner    = 1,
 222                         .has_dvb      = 1,
 223                         .has_zl10353  = 1,
 224                         .has_eeprom   = 1,
 225                         .has_remote   = 1,
 226                 },
 227                 .gpio_addr_tun_reset = TM6010_GPIO_2,
 228         }
 229 };
 230
 231 /* table of devices that work with this driver */
 232 struct usb_device_id tm6000_id_table [] = {
 233         { USB_DEVICE(0x6000, 0x0001), .driver_info = TM5600_BOARD_10MOONS_UT821 },
 234         { USB_DEVICE(0x6000, 0x0002), .driver_info = TM6010_BOARD_GENERIC },
 235         { USB_DEVICE(0x06e1, 0xf332), .driver_info = TM6000_BOARD_ADSTECH_DUAL_TV },
 236         { USB_DEVICE(0x14aa, 0x0620), .driver_info = TM6000_BOARD_FREECOM_AND_SIMILAR },
 237         { USB_DEVICE(0x06e1, 0xb339), .driver_info = TM6000_BOARD_ADSTECH_MINI_DUAL_TV },
 238         { USB_DEVICE(0x2040, 0x6600), .driver_info = TM6010_BOARD_HAUPPAUGE_900H },
 239         { USB_DEVICE(0x6000, 0xdec0), .driver_info = TM6010_BOARD_BEHOLD_WANDER },
 240         { USB_DEVICE(0x6000, 0xdec1), .driver_info = TM6010_BOARD_BEHOLD_VOYAGER },
 241         { USB_DEVICE(0x0ccd, 0x0086), .driver_info = TM6010_BOARD_TERRATEC_CINERGY_HYBRID_XE },
 242         { },
 243 };
 244
 245 /* Tuner callback to provide the proper gpio changes needed for xc2028 */
 246
 247 int tm6000_tuner_callback(void *ptr, int component, int command, int arg)
 248 {
 249         int rc=0;
 250         struct tm6000_core *dev = ptr;
 251
 252         if (dev->tuner_type!=TUNER_XC2028)
 253                 return 0;
 254
 255         switch (command) {
 256         case XC2028_RESET_CLK:
 257                 tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT,
 258                                         0x02, arg);
 259                 msleep(10);
 260                 rc=tm6000_set_reg (dev, REQ_03_SET_GET_MCU_PIN,
 261                                         TM6000_GPIO_CLK, 0);
 262                 if (rc<0)
 263                         return rc;
 264                 msleep(10);
 265                 rc=tm6000_set_reg (dev, REQ_03_SET_GET_MCU_PIN,
 266                                         TM6000_GPIO_CLK, 1);
 267                 break;
 268         case XC2028_TUNER_RESET:
 269                 /* Reset codes during load firmware */
 270                 switch (arg) {
 271                 case 0:
 272                         tm6000_set_reg (dev, REQ_03_SET_GET_MCU_PIN,
 273                                         dev->tuner_reset_gpio, 0x00);
 274                         msleep(130);
 275                         tm6000_set_reg (dev, REQ_03_SET_GET_MCU_PIN,
 276                                         dev->tuner_reset_gpio, 0x01);
 277                         msleep(130);
 278                         break;
 279                 case 1:
 280                         tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT,
 281                                                 0x02, 0x01);
 282                         msleep(10);
 283                         break;
 284
 285                 case 2:
 286                         rc=tm6000_set_reg (dev, REQ_03_SET_GET_MCU_PIN,
 287                                                 TM6000_GPIO_CLK, 0);
 288                         if (rc<0)
 289                                 return rc;
 290                         msleep(100);
 291                         rc=tm6000_set_reg (dev, REQ_03_SET_GET_MCU_PIN,
 292                                                 TM6000_GPIO_CLK, 1);
 293                         msleep(100);
 294                         break;
 295                 }
 296         }
 297         return (rc);
 298 }
 299
 300 int tm6000_cards_setup(struct tm6000_core *dev)
 301 {
 302         int i, rc;
 303
 304         /*
 305          * Board-specific initialization sequence. Handles all GPIO
 306          * initialization sequences that are board-specific.
 307          * Up to now, all found devices use GPIO1 and GPIO4 at the same way.
 308          * Probably, they're all based on some reference device. Due to that,
 309          * there's a common routine at the end to handle those GPIO's. Devices
 310          * that use different pinups or init sequences can just return at
 311          * the board-specific session.
 312          */
 313         switch (dev->model) {
 314         case TM6010_BOARD_HAUPPAUGE_900H:
 315                 /* Turn xceive 3028 on */
 316                 tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6010_GPIO_3, 0x01);
 317                 msleep(11);
 318                 break;
 319         default:
 320                 break;
 321         }
 322
 323         /*
 324          * Default initialization. Most of the devices seem to use GPIO1
 325          * and GPIO4.on the same way, so, this handles the common sequence
 326          * used by most devices.
 327          * If a device uses a different sequence or different GPIO pins for
 328          * reset, just add the code at the board-specific part
 329          */
 330         for (i = 0; i < 2; i++) {
 331                 rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
 332                                         dev->tuner_reset_gpio, 0x00);
 333                 if (rc < 0) {
 334                         printk(KERN_ERR "Error %i doing GPIO1 reset\n", rc);
 335                         return rc;
 336                 }
 337
 338                 msleep(10); /* Just to be conservative */
 339                 rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
 340                                         dev->tuner_reset_gpio, 0x01);
 341                 if (rc < 0) {
 342                         printk(KERN_ERR "Error %i doing GPIO1 reset\n", rc);
 343                         return rc;
 344                 }
 345
 346                 msleep(10);
 347                 rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_4, 0);
 348                 if (rc < 0) {
 349                         printk(KERN_ERR "Error %i doing GPIO4 reset\n", rc);
 350                         return rc;
 351                 }
 352
 353                 msleep(10);
 354                 rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_4, 1);
 355                 if (rc < 0) {
 356                         printk(KERN_ERR "Error %i doing GPIO4 reset\n", rc);
 357                         return rc;
 358                 }
 359
 360                 if (!i) {
 361                         rc = tm6000_get_reg16(dev, 0x40, 0, 0);
 362                         if (rc >= 0)
 363                                 printk(KERN_DEBUG "board=%d\n", rc);
 364                 }
 365         }
 366
 367         msleep(50);
 368
 369         return 0;
 370 };
 371
 372 static void tm6000_config_tuner (struct tm6000_core *dev)
 373 {
 374         struct tuner_setup           tun_setup;
 375
 376         /* Load tuner module */
 377         v4l2_i2c_new_subdev(&dev->v4l2_dev, &dev->i2c_adap,
 378                 "tuner", "tuner",dev->tuner_addr, NULL);
 379
 380         memset(&tun_setup, 0, sizeof(tun_setup));
 381         tun_setup.type   = dev->tuner_type;
 382         tun_setup.addr   = dev->tuner_addr;
 383         tun_setup.mode_mask = T_ANALOG_TV | T_RADIO | T_DIGITAL_TV;
 384         tun_setup.tuner_callback = tm6000_tuner_callback;
 385
 386         v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_type_addr, &tun_setup);
 387
 388         if (dev->tuner_type == TUNER_XC2028) {
 389                 struct v4l2_priv_tun_config  xc2028_cfg;
 390                 struct xc2028_ctrl           ctl;
 391
 392                 memset(&xc2028_cfg, 0, sizeof(xc2028_cfg));
 393                 memset (&ctl,0,sizeof(ctl));
 394
 395                 ctl.input1 = 1;
 396                 ctl.read_not_reliable = 0;
 397                 ctl.msleep = 10;
 398                 ctl.demod = XC3028_FE_ZARLINK456;
 399                 ctl.vhfbw7 = 1;
 400                 ctl.uhfbw8 = 1;
 401                 xc2028_cfg.tuner = TUNER_XC2028;
 402                 xc2028_cfg.priv  = &ctl;
 403
 404                 switch(dev->model) {
 405                 case TM6010_BOARD_HAUPPAUGE_900H:
 406                 case TM6010_BOARD_TERRATEC_CINERGY_HYBRID_XE:
 407                         ctl.fname = "xc3028L-v36.fw";
 408                         break;
 409                 default:
 410                         if (dev->dev_type == TM6010)
 411                                 ctl.fname = "xc3028-v27.fw";
 412                         else
 413                                 ctl.fname = "tm6000-xc3028.fw";
 414                 }
 415
 416                 printk(KERN_INFO "Setting firmware parameters for xc2028\n");
 417
 418                 v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_config,
 419                                      &xc2028_cfg);
 420         }
 421 }
 422
 423 static int tm6000_init_dev(struct tm6000_core *dev)
 424 {
 425         struct v4l2_frequency f;
 426         int rc = 0;
 427
 428         mutex_init(&dev->lock);
 429
 430         mutex_lock(&dev->lock);
 431
 432         /* Initializa board-specific data */
 433         dev->dev_type   = tm6000_boards[dev->model].type;
 434         dev->tuner_type = tm6000_boards[dev->model].tuner_type;
 435         dev->tuner_addr = tm6000_boards[dev->model].tuner_addr;
 436         dev->tuner_reset_gpio = tm6000_boards[dev->model].gpio_addr_tun_reset;
 437
 438         dev->demod_addr = tm6000_boards[dev->model].demod_addr;
 439
 440         dev->caps = tm6000_boards[dev->model].caps;
 441
 442         /* initialize hardware */
 443         rc=tm6000_init (dev);
 444         if (rc<0)
 445                 goto err;
 446
 447         rc = v4l2_device_register(&dev->udev->dev, &dev->v4l2_dev);
 448         if (rc < 0)
 449                 goto err;
 450
 451         /* register i2c bus */
 452         rc=tm6000_i2c_register(dev);
 453         if (rc<0)
 454                 goto err;
 455
 456         /* Default values for STD and resolutions */
 457         dev->width = 720;
 458         dev->height = 480;
 459         dev->norm = V4L2_STD_PAL_M;
 460
 461         /* Configure tuner */
 462         tm6000_config_tuner (dev);
 463
 464         /* Set video standard */
 465         v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm);
 466
 467         /* Set tuner frequency - also loads firmware on xc2028/xc3028 */
 468         f.tuner = 0;
 469         f.type = V4L2_TUNER_ANALOG_TV;
 470         f.frequency = 3092;     /* 193.25 MHz */
 471         dev->freq = f.frequency;
 472         v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f);
 473
 474         if (dev->caps.has_tda9874)
 475                 v4l2_i2c_new_subdev(&dev->v4l2_dev, &dev->i2c_adap,
 476                         "tvaudio", "tvaudio", I2C_ADDR_TDA9874, NULL);
 477
 478         /* register and initialize V4L2 */
 479         rc=tm6000_v4l2_register(dev);
 480         if (rc<0)
 481                 goto err;
 482
 483         if(dev->caps.has_dvb) {
 484                 dev->dvb = kzalloc(sizeof(*(dev->dvb)), GFP_KERNEL);
 485                 if(!dev->dvb) {
 486                         rc = -ENOMEM;
 487                         goto err2;
 488                 }
 489
 490 #ifdef CONFIG_VIDEO_TM6000_DVB
 491                 rc = tm6000_dvb_register(dev);
 492                 if(rc < 0) {
 493                         kfree(dev->dvb);
 494                         dev->dvb = NULL;
 495                         goto err2;
 496                 }
 497 #endif
 498         }
 499         return 0;
 500
 501 err2:
 502         v4l2_device_unregister(&dev->v4l2_dev);
 503
 504 err:
 505         mutex_unlock(&dev->lock);
 506         return rc;
 507 }
 508
 509 /* high bandwidth multiplier, as encoded in highspeed endpoint descriptors */
 510 #define hb_mult(wMaxPacketSize) (1 + (((wMaxPacketSize) >> 11) & 0x03))
 511
 512 static void get_max_endpoint (  struct usb_device *usbdev,
 513                                 char *msgtype,
 514                                 struct usb_host_endpoint *curr_e,
 515                                 unsigned int *maxsize,
 516                                 struct usb_host_endpoint **ep  )
 517 {
 518         u16 tmp = le16_to_cpu(curr_e->desc.wMaxPacketSize);
 519         unsigned int size = tmp & 0x7ff;
 520
 521         if (usbdev->speed == USB_SPEED_HIGH)
 522                 size = size * hb_mult (tmp);
 523
 524         if (size>*maxsize) {
 525                 *ep = curr_e;
 526                 *maxsize = size;
 527                 printk("tm6000: %s endpoint: 0x%02x (max size=%u bytes)\n",
 528                                         msgtype, curr_e->desc.bEndpointAddress,
 529                                         size);
 530         }
 531 }
 532
 533 /*
 534  * tm6000_usb_probe()
 535  * checks for supported devices
 536  */
 537 static int tm6000_usb_probe(struct usb_interface *interface,
 538                             const struct usb_device_id *id)
 539 {
 540         struct usb_device *usbdev;
 541         struct tm6000_core *dev = NULL;
 542         int i,rc=0;
 543         int nr=0;
 544         char *speed;
 545
 546
 547         usbdev=usb_get_dev(interface_to_usbdev(interface));
 548
 549         /* Selects the proper interface */
 550         rc=usb_set_interface(usbdev,0,1);
 551         if (rc<0)
 552                 goto err;
 553
 554         /* Check to see next free device and mark as used */
 555         nr=find_first_zero_bit(&tm6000_devused,TM6000_MAXBOARDS);
 556         if (nr >= TM6000_MAXBOARDS) {
 557                 printk ("tm6000: Supports only %i tm60xx boards.\n",TM6000_MAXBOARDS);
 558                 usb_put_dev(usbdev);
 559                 return -ENOMEM;
 560         }
 561
 562         /* Create and initialize dev struct */
 563         dev = kzalloc(sizeof(*dev), GFP_KERNEL);
 564         if (dev == NULL) {
 565                 printk ("tm6000" ": out of memory!\n");
 566                 usb_put_dev(usbdev);
 567                 return -ENOMEM;
 568         }
 569         spin_lock_init(&dev->slock);
 570
 571         /* Increment usage count */
 572         tm6000_devused|=1<<nr;
 573         snprintf(dev->name, 29, "tm6000 #%d", nr);
 574
 575         dev->model=id->driver_info;
 576         if ((card[nr]>=0) && (card[nr]<ARRAY_SIZE(tm6000_boards))) {
 577                 dev->model=card[nr];
 578         }
 579
 580         INIT_LIST_HEAD(&dev->tm6000_corelist);
 581         dev->udev= usbdev;
 582         dev->devno=nr;
 583
 584         switch (usbdev->speed) {
 585         case USB_SPEED_LOW:
 586                 speed = "1.5";
 587                 break;
 588         case USB_SPEED_UNKNOWN:
 589         case USB_SPEED_FULL:
 590                 speed = "12";
 591                 break;
 592         case USB_SPEED_HIGH:
 593                 speed = "480";
 594                 break;
 595         default:
 596                 speed = "unknown";
 597         }
 598
 599
 600
 601         /* Get endpoints */
 602         for (i = 0; i < interface->num_altsetting; i++) {
 603                 int ep;
 604
 605                 for (ep = 0; ep < interface->altsetting[i].desc.bNumEndpoints; ep++) {
 606                         struct usb_host_endpoint        *e;
 607                         int dir_out;
 608
 609                         e = &interface->altsetting[i].endpoint[ep];
 610
 611                         dir_out = ((e->desc.bEndpointAddress &
 612                                         USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT);
 613
 614                         printk("tm6000: alt %d, interface %i, class %i\n",
 615                                i,
 616                                interface->altsetting[i].desc.bInterfaceNumber,
 617                                interface->altsetting[i].desc.bInterfaceClass);
 618
 619                         switch (e->desc.bmAttributes) {
 620                         case USB_ENDPOINT_XFER_BULK:
 621                                 if (!dir_out) {
 622                                         get_max_endpoint (usbdev, "Bulk IN", e,
 623                                                         &dev->max_bulk_in,
 624                                                         &dev->bulk_in);
 625                                 } else {
 626                                         get_max_endpoint (usbdev, "Bulk OUT", e,
 627                                                         &dev->max_bulk_out,
 628                                                         &dev->bulk_out);
 629                                 }
 630                                 break;
 631                         case USB_ENDPOINT_XFER_ISOC:
 632                                 if (!dir_out) {
 633                                         get_max_endpoint (usbdev, "ISOC IN", e,
 634                                                         &dev->max_isoc_in,
 635                                                         &dev->isoc_in);
 636                                 } else {
 637                                         get_max_endpoint (usbdev, "ISOC OUT", e,
 638                                                         &dev->max_isoc_out,
 639                                                         &dev->isoc_out);
 640                                 }
 641                                 break;
 642                         }
 643                 }
 644         }
 645
 646
 647         printk("tm6000: New video device @ %s Mbps (%04x:%04x, ifnum %d)\n",
 648                 speed,
 649                 le16_to_cpu(dev->udev->descriptor.idVendor),
 650                 le16_to_cpu(dev->udev->descriptor.idProduct),
 651                 interface->altsetting->desc.bInterfaceNumber);
 652
 653 /* check if the the device has the iso in endpoint at the correct place */
 654         if (!dev->isoc_in) {
 655                 printk("tm6000: probing error: no IN ISOC endpoint!\n");
 656                 rc= -ENODEV;
 657
 658                 goto err;
 659         }
 660
 661         /* save our data pointer in this interface device */
 662         usb_set_intfdata(interface, dev);
 663
 664         printk("tm6000: Found %s\n", tm6000_boards[dev->model].name);
 665
 666         rc=tm6000_init_dev(dev);
 667
 668         if (rc<0)
 669                 goto err;
 670
 671         return 0;
 672
 673 err:
 674         printk("tm6000: Error %d while registering\n", rc);
 675
 676         tm6000_devused&=~(1<<nr);
 677         usb_put_dev(usbdev);
 678
 679         kfree(dev);
 680         return rc;
 681 }
 682
 683 /*
 684  * tm6000_usb_disconnect()
 685  * called when the device gets diconencted
 686  * video device will be unregistered on v4l2_close in case it is still open
 687  */
 688 static void tm6000_usb_disconnect(struct usb_interface *interface)
 689 {
 690         struct tm6000_core *dev = usb_get_intfdata(interface);
 691         usb_set_intfdata(interface, NULL);
 692
 693         if (!dev)
 694                 return;
 695
 696         printk("tm6000: disconnecting %s\n", dev->name);
 697
 698         mutex_lock(&dev->lock);
 699
 700 #ifdef CONFIG_VIDEO_TM6000_DVB
 701         if(dev->dvb) {
 702                 tm6000_dvb_unregister(dev);
 703                 kfree(dev->dvb);
 704         }
 705 #endif
 706
 707         tm6000_v4l2_unregister(dev);
 708
 709         tm6000_i2c_unregister(dev);
 710
 711         v4l2_device_unregister(&dev->v4l2_dev);
 712
 713 //      wake_up_interruptible_all(&dev->open);
 714
 715         dev->state |= DEV_DISCONNECTED;
 716
 717         usb_put_dev(dev->udev);
 718
 719         mutex_unlock(&dev->lock);
 720         kfree(dev);
 721 }
 722
 723 static struct usb_driver tm6000_usb_driver = {
 724                 .name = "tm6000",
 725                 .probe = tm6000_usb_probe,
 726                 .disconnect = tm6000_usb_disconnect,
 727                 .id_table = tm6000_id_table,
 728 };
 729
 730 static int __init tm6000_module_init(void)
 731 {
 732         int result;
 733
 734         printk(KERN_INFO "tm6000" " v4l2 driver version %d.%d.%d loaded\n",
 735                (TM6000_VERSION  >> 16) & 0xff,
 736                (TM6000_VERSION  >> 8) & 0xff, TM6000_VERSION  & 0xff);
 737
 738         /* register this driver with the USB subsystem */
 739         result = usb_register(&tm6000_usb_driver);
 740         if (result)
 741                 printk("tm6000"
 742                            " usb_register failed. Error number %d.\n", result);
 743
 744         return result;
 745 }
 746
 747 static void __exit tm6000_module_exit(void)
 748 {
 749         /* deregister at USB subsystem */
 750         usb_deregister(&tm6000_usb_driver);
 751 }
 752
 753 module_init(tm6000_module_init);
 754 module_exit(tm6000_module_exit);
 755
 756 MODULE_DESCRIPTION("Trident TVMaster TM5600/TM6000 USB2 adapter");
 757 MODULE_AUTHOR("Mauro Carvalho Chehab");
 758 MODULE_LICENSE("GPL");