drivers/staging/go7007/go7007-usb.c

   1 /*
   2  * Copyright (C) 2005-2006 Micronas USA Inc.
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License (Version 2) as
   6  * published by the Free Software Foundation.
   7  *
   8  * This program is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11  * GNU General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License
  14  * along with this program; if not, write to the Free Software Foundation,
  15  * Inc., 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
  16  */
  17
  18 #include <linux/module.h>
  19 #include <linux/kernel.h>
  20 #include <linux/init.h>
  21 #include <linux/wait.h>
  22 #include <linux/list.h>
  23 #include <linux/slab.h>
  24 #include <linux/time.h>
  25 #include <linux/mm.h>
  26 #include <linux/usb.h>
  27 #include <linux/i2c.h>
  28 #include <asm/byteorder.h>
  29 #include <media/tvaudio.h>
  30
  31 #include "go7007-priv.h"
  32 #include "wis-i2c.h"
  33
  34 static unsigned int assume_endura;
  35 module_param(assume_endura, int, 0644);
  36 MODULE_PARM_DESC(assume_endura, "when probing fails, "
  37                                 "hardware is a Pelco Endura");
  38
  39 /* #define GO7007_USB_DEBUG */
  40 /* #define GO7007_I2C_DEBUG */ /* for debugging the EZ-USB I2C adapter */
  41
  42 #define HPI_STATUS_ADDR 0xFFF4
  43 #define INT_PARAM_ADDR  0xFFF6
  44 #define INT_INDEX_ADDR  0xFFF8
  45
  46 /*
  47  * Pipes on EZ-USB interface:
  48  *      0 snd - Control
  49  *      0 rcv - Control
  50  *      2 snd - Download firmware (control)
  51  *      4 rcv - Read Interrupt (interrupt)
  52  *      6 rcv - Read Video (bulk)
  53  *      8 rcv - Read Audio (bulk)
  54  */
  55
  56 #define GO7007_USB_EZUSB                (1<<0)
  57 #define GO7007_USB_EZUSB_I2C            (1<<1)
  58
  59 struct go7007_usb_board {
  60         unsigned int flags;
  61         struct go7007_board_info main_info;
  62 };
  63
  64 struct go7007_usb {
  65         struct go7007_usb_board *board;
  66         struct mutex i2c_lock;
  67         struct usb_device *usbdev;
  68         struct urb *video_urbs[8];
  69         struct urb *audio_urbs[8];
  70         struct urb *intr_urb;
  71 };
  72
  73 /*********************** Product specification data ***********************/
  74
  75 static struct go7007_usb_board board_matrix_ii = {
  76         .flags          = GO7007_USB_EZUSB,
  77         .main_info      = {
  78                 .firmware        = "go7007tv.bin",
  79                 .flags           = GO7007_BOARD_HAS_AUDIO |
  80                                         GO7007_BOARD_USE_ONBOARD_I2C,
  81                 .audio_flags     = GO7007_AUDIO_I2S_MODE_1 |
  82                                         GO7007_AUDIO_WORD_16,
  83                 .audio_rate      = 48000,
  84                 .audio_bclk_div  = 8,
  85                 .audio_main_div  = 2,
  86                 .hpi_buffer_cap  = 7,
  87                 .sensor_flags    = GO7007_SENSOR_656 |
  88                                         GO7007_SENSOR_VALID_ENABLE |
  89                                         GO7007_SENSOR_TV |
  90                                         GO7007_SENSOR_VBI |
  91                                         GO7007_SENSOR_SCALING,
  92                 .num_i2c_devs    = 1,
  93                 .i2c_devs        = {
  94                         {
  95                                 .type   = "wis_saa7115",
  96                                 .id     = I2C_DRIVERID_WIS_SAA7115,
  97                                 .addr   = 0x20,
  98                         },
  99                 },
 100                 .num_inputs      = 2,
 101                 .inputs          = {
 102                         {
 103                                 .video_input    = 0,
 104                                 .name           = "Composite",
 105                         },
 106                         {
 107                                 .video_input    = 9,
 108                                 .name           = "S-Video",
 109                         },
 110                 },
 111         },
 112 };
 113
 114 static struct go7007_usb_board board_matrix_reload = {
 115         .flags          = GO7007_USB_EZUSB,
 116         .main_info      = {
 117                 .firmware        = "go7007tv.bin",
 118                 .flags           = GO7007_BOARD_HAS_AUDIO |
 119                                         GO7007_BOARD_USE_ONBOARD_I2C,
 120                 .audio_flags     = GO7007_AUDIO_I2S_MODE_1 |
 121                                         GO7007_AUDIO_I2S_MASTER |
 122                                         GO7007_AUDIO_WORD_16,
 123                 .audio_rate      = 48000,
 124                 .audio_bclk_div  = 8,
 125                 .audio_main_div  = 2,
 126                 .hpi_buffer_cap  = 7,
 127                 .sensor_flags    = GO7007_SENSOR_656 |
 128                                         GO7007_SENSOR_TV,
 129                 .num_i2c_devs    = 1,
 130                 .i2c_devs        = {
 131                         {
 132                                 .type   = "wis_saa7113",
 133                                 .id     = I2C_DRIVERID_WIS_SAA7113,
 134                                 .addr   = 0x25,
 135                         },
 136                 },
 137                 .num_inputs      = 2,
 138                 .inputs          = {
 139                         {
 140                                 .video_input    = 0,
 141                                 .name           = "Composite",
 142                         },
 143                         {
 144                                 .video_input    = 9,
 145                                 .name           = "S-Video",
 146                         },
 147                 },
 148         },
 149 };
 150
 151 static struct go7007_usb_board board_star_trek = {
 152         .flags          = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C,
 153         .main_info      = {
 154                 .firmware        = "go7007tv.bin",
 155                 .flags           = GO7007_BOARD_HAS_AUDIO, /* |
 156                                         GO7007_BOARD_HAS_TUNER, */
 157                 .sensor_flags    = GO7007_SENSOR_656 |
 158                                         GO7007_SENSOR_VALID_ENABLE |
 159                                         GO7007_SENSOR_TV |
 160                                         GO7007_SENSOR_VBI |
 161                                         GO7007_SENSOR_SCALING,
 162                 .audio_flags     = GO7007_AUDIO_I2S_MODE_1 |
 163                                         GO7007_AUDIO_WORD_16,
 164                 .audio_bclk_div  = 8,
 165                 .audio_main_div  = 2,
 166                 .hpi_buffer_cap  = 7,
 167                 .num_i2c_devs    = 1,
 168                 .i2c_devs        = {
 169                         {
 170                                 .type   = "wis_saa7115",
 171                                 .id     = I2C_DRIVERID_WIS_SAA7115,
 172                                 .addr   = 0x20,
 173                         },
 174                 },
 175                 .num_inputs      = 2,
 176                 .inputs          = {
 177                         {
 178                                 .video_input    = 1,
 179                         /*      .audio_input    = AUDIO_EXTERN, */
 180                                 .name           = "Composite",
 181                         },
 182                         {
 183                                 .video_input    = 8,
 184                         /*      .audio_input    = AUDIO_EXTERN, */
 185                                 .name           = "S-Video",
 186                         },
 187                 /*      {
 188                  *              .video_input    = 3,
 189                  *              .audio_input    = AUDIO_TUNER,
 190                  *              .name           = "Tuner",
 191                  *      },
 192                  */
 193                 },
 194         },
 195 };
 196
 197 static struct go7007_usb_board board_px_tv402u = {
 198         .flags          = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C,
 199         .main_info      = {
 200                 .firmware        = "go7007tv.bin",
 201                 .flags           = GO7007_BOARD_HAS_AUDIO |
 202                                         GO7007_BOARD_HAS_TUNER,
 203                 .sensor_flags    = GO7007_SENSOR_656 |
 204                                         GO7007_SENSOR_VALID_ENABLE |
 205                                         GO7007_SENSOR_TV |
 206                                         GO7007_SENSOR_VBI |
 207                                         GO7007_SENSOR_SCALING,
 208                 .audio_flags     = GO7007_AUDIO_I2S_MODE_1 |
 209                                         GO7007_AUDIO_WORD_16,
 210                 .audio_bclk_div  = 8,
 211                 .audio_main_div  = 2,
 212                 .hpi_buffer_cap  = 7,
 213                 .num_i2c_devs    = 3,
 214                 .i2c_devs        = {
 215                         {
 216                                 .type   = "wis_saa7115",
 217                                 .id     = I2C_DRIVERID_WIS_SAA7115,
 218                                 .addr   = 0x20,
 219                         },
 220                         {
 221                                 .type   = "wis_uda1342",
 222                                 .id     = I2C_DRIVERID_WIS_UDA1342,
 223                                 .addr   = 0x1a,
 224                         },
 225                         {
 226                                 .type   = "wis_sony_tuner",
 227                                 .id     = I2C_DRIVERID_WIS_SONY_TUNER,
 228                                 .addr   = 0x60,
 229                         },
 230                 },
 231                 .num_inputs      = 3,
 232                 .inputs          = {
 233                         {
 234                                 .video_input    = 1,
 235                                 .audio_input    = TVAUDIO_INPUT_EXTERN,
 236                                 .name           = "Composite",
 237                         },
 238                         {
 239                                 .video_input    = 8,
 240                                 .audio_input    = TVAUDIO_INPUT_EXTERN,
 241                                 .name           = "S-Video",
 242                         },
 243                         {
 244                                 .video_input    = 3,
 245                                 .audio_input    = TVAUDIO_INPUT_TUNER,
 246                                 .name           = "Tuner",
 247                         },
 248                 },
 249         },
 250 };
 251
 252 static struct go7007_usb_board board_xmen = {
 253         .flags          = 0,
 254         .main_info      = {
 255                 .firmware         = "go7007tv.bin",
 256                 .flags            = GO7007_BOARD_USE_ONBOARD_I2C,
 257                 .hpi_buffer_cap   = 0,
 258                 .sensor_flags     = GO7007_SENSOR_VREF_POLAR,
 259                 .sensor_width     = 320,
 260                 .sensor_height    = 240,
 261                 .sensor_framerate = 30030,
 262                 .audio_flags      = GO7007_AUDIO_ONE_CHANNEL |
 263                                         GO7007_AUDIO_I2S_MODE_3 |
 264                                         GO7007_AUDIO_WORD_14 |
 265                                         GO7007_AUDIO_I2S_MASTER |
 266                                         GO7007_AUDIO_BCLK_POLAR |
 267                                         GO7007_AUDIO_OKI_MODE,
 268                 .audio_rate       = 8000,
 269                 .audio_bclk_div   = 48,
 270                 .audio_main_div   = 1,
 271                 .num_i2c_devs     = 1,
 272                 .i2c_devs         = {
 273                         {
 274                                 .type   = "wis_ov7640",
 275                                 .id     = I2C_DRIVERID_WIS_OV7640,
 276                                 .addr   = 0x21,
 277                         },
 278                 },
 279                 .num_inputs       = 1,
 280                 .inputs           = {
 281                         {
 282                                 .name           = "Camera",
 283                         },
 284                 },
 285         },
 286 };
 287
 288 static struct go7007_usb_board board_matrix_revolution = {
 289         .flags          = GO7007_USB_EZUSB,
 290         .main_info      = {
 291                 .firmware        = "go7007tv.bin",
 292                 .flags           = GO7007_BOARD_HAS_AUDIO |
 293                                         GO7007_BOARD_USE_ONBOARD_I2C,
 294                 .audio_flags     = GO7007_AUDIO_I2S_MODE_1 |
 295                                         GO7007_AUDIO_I2S_MASTER |
 296                                         GO7007_AUDIO_WORD_16,
 297                 .audio_rate      = 48000,
 298                 .audio_bclk_div  = 8,
 299                 .audio_main_div  = 2,
 300                 .hpi_buffer_cap  = 7,
 301                 .sensor_flags    = GO7007_SENSOR_656 |
 302                                         GO7007_SENSOR_TV |
 303                                         GO7007_SENSOR_VBI,
 304                 .num_i2c_devs    = 1,
 305                 .i2c_devs        = {
 306                         {
 307                                 .type   = "wis_tw9903",
 308                                 .id     = I2C_DRIVERID_WIS_TW9903,
 309                                 .addr   = 0x44,
 310                         },
 311                 },
 312                 .num_inputs      = 2,
 313                 .inputs          = {
 314                         {
 315                                 .video_input    = 2,
 316                                 .name           = "Composite",
 317                         },
 318                         {
 319                                 .video_input    = 8,
 320                                 .name           = "S-Video",
 321                         },
 322                 },
 323         },
 324 };
 325
 326 static struct go7007_usb_board board_lifeview_lr192 = {
 327         .flags          = GO7007_USB_EZUSB,
 328         .main_info      = {
 329                 .firmware        = "go7007tv.bin",
 330                 .flags           = GO7007_BOARD_HAS_AUDIO |
 331                                         GO7007_BOARD_USE_ONBOARD_I2C,
 332                 .audio_flags     = GO7007_AUDIO_I2S_MODE_1 |
 333                                         GO7007_AUDIO_WORD_16,
 334                 .audio_rate      = 48000,
 335                 .audio_bclk_div  = 8,
 336                 .audio_main_div  = 2,
 337                 .hpi_buffer_cap  = 7,
 338                 .sensor_flags    = GO7007_SENSOR_656 |
 339                                         GO7007_SENSOR_VALID_ENABLE |
 340                                         GO7007_SENSOR_TV |
 341                                         GO7007_SENSOR_VBI |
 342                                         GO7007_SENSOR_SCALING,
 343                 .num_i2c_devs    = 0,
 344                 .num_inputs      = 1,
 345                 .inputs          = {
 346                         {
 347                                 .video_input    = 0,
 348                                 .name           = "Composite",
 349                         },
 350                 },
 351         },
 352 };
 353
 354 static struct go7007_usb_board board_endura = {
 355         .flags          = 0,
 356         .main_info      = {
 357                 .firmware        = "go7007tv.bin",
 358                 .flags           = 0,
 359                 .audio_flags     = GO7007_AUDIO_I2S_MODE_1 |
 360                                         GO7007_AUDIO_I2S_MASTER |
 361                                         GO7007_AUDIO_WORD_16,
 362                 .audio_rate      = 8000,
 363                 .audio_bclk_div  = 48,
 364                 .audio_main_div  = 8,
 365                 .hpi_buffer_cap  = 0,
 366                 .sensor_flags    = GO7007_SENSOR_656 |
 367                                         GO7007_SENSOR_TV,
 368                 .sensor_h_offset = 8,
 369                 .num_i2c_devs    = 0,
 370                 .num_inputs      = 1,
 371                 .inputs          = {
 372                         {
 373                                 .name           = "Camera",
 374                         },
 375                 },
 376         },
 377 };
 378
 379 static struct go7007_usb_board board_adlink_mpg24 = {
 380         .flags          = 0,
 381         .main_info      = {
 382                 .firmware        = "go7007tv.bin",
 383                 .flags           = GO7007_BOARD_USE_ONBOARD_I2C,
 384                 .audio_flags     = GO7007_AUDIO_I2S_MODE_1 |
 385                                         GO7007_AUDIO_I2S_MASTER |
 386                                         GO7007_AUDIO_WORD_16,
 387                 .audio_rate      = 48000,
 388                 .audio_bclk_div  = 8,
 389                 .audio_main_div  = 2,
 390                 .hpi_buffer_cap  = 0,
 391                 .sensor_flags    = GO7007_SENSOR_656 |
 392                                         GO7007_SENSOR_TV |
 393                                         GO7007_SENSOR_VBI,
 394                 .num_i2c_devs    = 1,
 395                 .i2c_devs        = {
 396                         {
 397                                 .type   = "wis_twTW2804",
 398                                 .id     = I2C_DRIVERID_WIS_TW2804,
 399                                 .addr   = 0x00, /* yes, really */
 400                         },
 401                 },
 402                 .num_inputs      = 1,
 403                 .inputs          = {
 404                         {
 405                                 .name           = "Composite",
 406                         },
 407                 },
 408         },
 409 };
 410
 411 static struct go7007_usb_board board_sensoray_2250 = {
 412         .flags          = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C,
 413         .main_info      = {
 414                 .firmware        = "go7007tv.bin",
 415                 .audio_flags     = GO7007_AUDIO_I2S_MODE_1 |
 416                                         GO7007_AUDIO_I2S_MASTER |
 417                                         GO7007_AUDIO_WORD_16,
 418                 .flags           = GO7007_BOARD_HAS_AUDIO,
 419                 .audio_rate      = 48000,
 420                 .audio_bclk_div  = 8,
 421                 .audio_main_div  = 2,
 422                 .hpi_buffer_cap  = 7,
 423                 .sensor_flags    = GO7007_SENSOR_656 |
 424                                         GO7007_SENSOR_TV,
 425                 .num_i2c_devs    = 1,
 426                 .i2c_devs        = {
 427                         {
 428                                 .type   = "s2250",
 429                                 .id     = I2C_DRIVERID_S2250,
 430                                 .addr   = 0x43,
 431                         },
 432                 },
 433                 .num_inputs      = 2,
 434                 .inputs          = {
 435                         {
 436                                 .video_input    = 0,
 437                                 .name           = "Composite",
 438                         },
 439                         {
 440                                 .video_input    = 1,
 441                                 .name           = "S-Video",
 442                         },
 443                 },
 444         },
 445 };
 446
 447 MODULE_FIRMWARE("go7007tv.bin");
 448
 449 static const struct usb_device_id go7007_usb_id_table[] = {
 450         {
 451                 .match_flags    = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION |
 452                                         USB_DEVICE_ID_MATCH_INT_INFO,
 453                 .idVendor       = 0x0eb1,  /* Vendor ID of WIS Technologies */
 454                 .idProduct      = 0x7007,  /* Product ID of GO7007SB chip */
 455                 .bcdDevice_lo   = 0x200,   /* Revision number of XMen */
 456                 .bcdDevice_hi   = 0x200,
 457                 .bInterfaceClass        = 255,
 458                 .bInterfaceSubClass     = 0,
 459                 .bInterfaceProtocol     = 255,
 460                 .driver_info    = (kernel_ulong_t)GO7007_BOARDID_XMEN,
 461         },
 462         {
 463                 .match_flags    = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
 464                 .idVendor       = 0x0eb1,  /* Vendor ID of WIS Technologies */
 465                 .idProduct      = 0x7007,  /* Product ID of GO7007SB chip */
 466                 .bcdDevice_lo   = 0x202,   /* Revision number of Matrix II */
 467                 .bcdDevice_hi   = 0x202,
 468                 .driver_info    = (kernel_ulong_t)GO7007_BOARDID_MATRIX_II,
 469         },
 470         {
 471                 .match_flags    = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
 472                 .idVendor       = 0x0eb1,  /* Vendor ID of WIS Technologies */
 473                 .idProduct      = 0x7007,  /* Product ID of GO7007SB chip */
 474                 .bcdDevice_lo   = 0x204,   /* Revision number of Matrix */
 475                 .bcdDevice_hi   = 0x204,   /*     Reloaded */
 476                 .driver_info    = (kernel_ulong_t)GO7007_BOARDID_MATRIX_RELOAD,
 477         },
 478         {
 479                 .match_flags    = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION |
 480                                         USB_DEVICE_ID_MATCH_INT_INFO,
 481                 .idVendor       = 0x0eb1,  /* Vendor ID of WIS Technologies */
 482                 .idProduct      = 0x7007,  /* Product ID of GO7007SB chip */
 483                 .bcdDevice_lo   = 0x205,   /* Revision number of XMen-II */
 484                 .bcdDevice_hi   = 0x205,
 485                 .bInterfaceClass        = 255,
 486                 .bInterfaceSubClass     = 0,
 487                 .bInterfaceProtocol     = 255,
 488                 .driver_info    = (kernel_ulong_t)GO7007_BOARDID_XMEN_II,
 489         },
 490         {
 491                 .match_flags    = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
 492                 .idVendor       = 0x0eb1,  /* Vendor ID of WIS Technologies */
 493                 .idProduct      = 0x7007,  /* Product ID of GO7007SB chip */
 494                 .bcdDevice_lo   = 0x208,   /* Revision number of Star Trek */
 495                 .bcdDevice_hi   = 0x208,
 496                 .driver_info    = (kernel_ulong_t)GO7007_BOARDID_STAR_TREK,
 497         },
 498         {
 499                 .match_flags    = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION |
 500                                         USB_DEVICE_ID_MATCH_INT_INFO,
 501                 .idVendor       = 0x0eb1,  /* Vendor ID of WIS Technologies */
 502                 .idProduct      = 0x7007,  /* Product ID of GO7007SB chip */
 503                 .bcdDevice_lo   = 0x209,   /* Revision number of XMen-III */
 504                 .bcdDevice_hi   = 0x209,
 505                 .bInterfaceClass        = 255,
 506                 .bInterfaceSubClass     = 0,
 507                 .bInterfaceProtocol     = 255,
 508                 .driver_info    = (kernel_ulong_t)GO7007_BOARDID_XMEN_III,
 509         },
 510         {
 511                 .match_flags    = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
 512                 .idVendor       = 0x0eb1,  /* Vendor ID of WIS Technologies */
 513                 .idProduct      = 0x7007,  /* Product ID of GO7007SB chip */
 514                 .bcdDevice_lo   = 0x210,   /* Revision number of Matrix */
 515                 .bcdDevice_hi   = 0x210,   /*     Revolution */
 516                 .driver_info    = (kernel_ulong_t)GO7007_BOARDID_MATRIX_REV,
 517         },
 518         {
 519                 .match_flags    = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
 520                 .idVendor       = 0x093b,  /* Vendor ID of Plextor */
 521                 .idProduct      = 0xa102,  /* Product ID of M402U */
 522                 .bcdDevice_lo   = 0x1,     /* revision number of Blueberry */
 523                 .bcdDevice_hi   = 0x1,
 524                 .driver_info    = (kernel_ulong_t)GO7007_BOARDID_PX_M402U,
 525         },
 526         {
 527                 .match_flags    = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
 528                 .idVendor       = 0x093b,  /* Vendor ID of Plextor */
 529                 .idProduct      = 0xa104,  /* Product ID of TV402U */
 530                 .bcdDevice_lo   = 0x1,
 531                 .bcdDevice_hi   = 0x1,
 532                 .driver_info    = (kernel_ulong_t)GO7007_BOARDID_PX_TV402U_ANY,
 533         },
 534         {
 535                 .match_flags    = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
 536                 .idVendor       = 0x10fd,  /* Vendor ID of Anubis Electronics */
 537                 .idProduct      = 0xde00,  /* Product ID of Lifeview LR192 */
 538                 .bcdDevice_lo   = 0x1,
 539                 .bcdDevice_hi   = 0x1,
 540                 .driver_info    = (kernel_ulong_t)GO7007_BOARDID_LIFEVIEW_LR192,
 541         },
 542         {
 543                 .match_flags    = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
 544                 .idVendor       = 0x1943,  /* Vendor ID Sensoray */
 545                 .idProduct      = 0x2250,  /* Product ID of 2250/2251 */
 546                 .bcdDevice_lo   = 0x1,
 547                 .bcdDevice_hi   = 0x1,
 548                 .driver_info    = (kernel_ulong_t)GO7007_BOARDID_SENSORAY_2250,
 549         },
 550         { }                                     /* Terminating entry */
 551 };
 552
 553 MODULE_DEVICE_TABLE(usb, go7007_usb_id_table);
 554
 555 /********************* Driver for EZ-USB HPI interface *********************/
 556
 557 static int go7007_usb_vendor_request(struct go7007 *go, int request,
 558                 int value, int index, void *transfer_buffer, int length, int in)
 559 {
 560         struct go7007_usb *usb = go->hpi_context;
 561         int timeout = 5000;
 562
 563         if (in) {
 564                 return usb_control_msg(usb->usbdev,
 565                                 usb_rcvctrlpipe(usb->usbdev, 0), request,
 566                                 USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
 567                                 value, index, transfer_buffer, length, timeout);
 568         } else {
 569                 return usb_control_msg(usb->usbdev,
 570                                 usb_sndctrlpipe(usb->usbdev, 0), request,
 571                                 USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 572                                 value, index, transfer_buffer, length, timeout);
 573         }
 574 }
 575
 576 static int go7007_usb_interface_reset(struct go7007 *go)
 577 {
 578         struct go7007_usb *usb = go->hpi_context;
 579         u16 intr_val, intr_data;
 580
 581         /* Reset encoder */
 582         if (go7007_write_interrupt(go, 0x0001, 0x0001) < 0)
 583                 return -1;
 584         msleep(100);
 585
 586         if (usb->board->flags & GO7007_USB_EZUSB) {
 587                 /* Reset buffer in EZ-USB */
 588 #ifdef GO7007_USB_DEBUG
 589                 printk(KERN_DEBUG "go7007-usb: resetting EZ-USB buffers\n");
 590 #endif
 591                 if (go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0 ||
 592                     go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0)
 593                         return -1;
 594
 595                 /* Reset encoder again */
 596                 if (go7007_write_interrupt(go, 0x0001, 0x0001) < 0)
 597                         return -1;
 598                 msleep(100);
 599         }
 600
 601         /* Wait for an interrupt to indicate successful hardware reset */
 602         if (go7007_read_interrupt(go, &intr_val, &intr_data) < 0 ||
 603                         (intr_val & ~0x1) != 0x55aa) {
 604                 printk(KERN_ERR
 605                         "go7007-usb: unable to reset the USB interface\n");
 606                 return -1;
 607         }
 608         return 0;
 609 }
 610
 611 static int go7007_usb_ezusb_write_interrupt(struct go7007 *go,
 612                                                 int addr, int data)
 613 {
 614         struct go7007_usb *usb = go->hpi_context;
 615         int i, r;
 616         u16 status_reg;
 617         int timeout = 500;
 618
 619 #ifdef GO7007_USB_DEBUG
 620         printk(KERN_DEBUG
 621                 "go7007-usb: WriteInterrupt: %04x %04x\n", addr, data);
 622 #endif
 623
 624         for (i = 0; i < 100; ++i) {
 625                 r = usb_control_msg(usb->usbdev,
 626                                 usb_rcvctrlpipe(usb->usbdev, 0), 0x14,
 627                                 USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
 628                                 0, HPI_STATUS_ADDR, &status_reg,
 629                                 sizeof(status_reg), timeout);
 630                 if (r < 0)
 631                         goto write_int_error;
 632                 __le16_to_cpus(&status_reg);
 633                 if (!(status_reg & 0x0010))
 634                         break;
 635                 msleep(10);
 636         }
 637         if (i == 100) {
 638                 printk(KERN_ERR
 639                         "go7007-usb: device is hung, status reg = 0x%04x\n",
 640                         status_reg);
 641                 return -1;
 642         }
 643         r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 0), 0x12,
 644                         USB_TYPE_VENDOR | USB_RECIP_DEVICE, data,
 645                         INT_PARAM_ADDR, NULL, 0, timeout);
 646         if (r < 0)
 647                 goto write_int_error;
 648         r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 0),
 649                         0x12, USB_TYPE_VENDOR | USB_RECIP_DEVICE, addr,
 650                         INT_INDEX_ADDR, NULL, 0, timeout);
 651         if (r < 0)
 652                 goto write_int_error;
 653         return 0;
 654
 655 write_int_error:
 656         printk(KERN_ERR "go7007-usb: error in WriteInterrupt: %d\n", r);
 657         return r;
 658 }
 659
 660 static int go7007_usb_onboard_write_interrupt(struct go7007 *go,
 661                                                 int addr, int data)
 662 {
 663         struct go7007_usb *usb = go->hpi_context;
 664         u8 *tbuf;
 665         int r;
 666         int timeout = 500;
 667
 668 #ifdef GO7007_USB_DEBUG
 669         printk(KERN_DEBUG
 670                 "go7007-usb: WriteInterrupt: %04x %04x\n", addr, data);
 671 #endif
 672
 673         tbuf = kmalloc(8, GFP_KERNEL);
 674         if (tbuf == NULL)
 675                 return -ENOMEM;
 676         memset(tbuf, 0, 8);
 677         tbuf[0] = data & 0xff;
 678         tbuf[1] = data >> 8;
 679         tbuf[2] = addr & 0xff;
 680         tbuf[3] = addr >> 8;
 681         r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 2), 0x00,
 682                         USB_TYPE_VENDOR | USB_RECIP_ENDPOINT, 0x55aa,
 683                         0xf0f0, tbuf, 8, timeout);
 684         kfree(tbuf);
 685         if (r < 0) {
 686                 printk(KERN_ERR "go7007-usb: error in WriteInterrupt: %d\n", r);
 687                 return r;
 688         }
 689         return 0;
 690 }
 691
 692 static void go7007_usb_readinterrupt_complete(struct urb *urb)
 693 {
 694         struct go7007 *go = (struct go7007 *)urb->context;
 695         u16 *regs = (u16 *)urb->transfer_buffer;
 696         int status = urb->status;
 697
 698         if (status) {
 699                 if (status != -ESHUTDOWN &&
 700                                 go->status != STATUS_SHUTDOWN) {
 701                         printk(KERN_ERR
 702                                 "go7007-usb: error in read interrupt: %d\n",
 703                                 urb->status);
 704                 } else {
 705                         wake_up(&go->interrupt_waitq);
 706                         return;
 707                 }
 708         } else if (urb->actual_length != urb->transfer_buffer_length) {
 709                 printk(KERN_ERR "go7007-usb: short read in interrupt pipe!\n");
 710         } else {
 711                 go->interrupt_available = 1;
 712                 go->interrupt_data = __le16_to_cpu(regs[0]);
 713                 go->interrupt_value = __le16_to_cpu(regs[1]);
 714 #ifdef GO7007_USB_DEBUG
 715                 printk(KERN_DEBUG "go7007-usb: ReadInterrupt: %04x %04x\n",
 716                                 go->interrupt_value, go->interrupt_data);
 717 #endif
 718         }
 719
 720         wake_up(&go->interrupt_waitq);
 721 }
 722
 723 static int go7007_usb_read_interrupt(struct go7007 *go)
 724 {
 725         struct go7007_usb *usb = go->hpi_context;
 726         int r;
 727
 728         r = usb_submit_urb(usb->intr_urb, GFP_KERNEL);
 729         if (r < 0) {
 730                 printk(KERN_ERR
 731                         "go7007-usb: unable to submit interrupt urb: %d\n", r);
 732                 return r;
 733         }
 734         return 0;
 735 }
 736
 737 static void go7007_usb_read_video_pipe_complete(struct urb *urb)
 738 {
 739         struct go7007 *go = (struct go7007 *)urb->context;
 740         int r, status = urb->status;
 741
 742         if (!go->streaming) {
 743                 wake_up_interruptible(&go->frame_waitq);
 744                 return;
 745         }
 746         if (status) {
 747                 printk(KERN_ERR "go7007-usb: error in video pipe: %d\n",
 748                         status);
 749                 return;
 750         }
 751         if (urb->actual_length != urb->transfer_buffer_length) {
 752                 printk(KERN_ERR "go7007-usb: short read in video pipe!\n");
 753                 return;
 754         }
 755         go7007_parse_video_stream(go, urb->transfer_buffer, urb->actual_length);
 756         r = usb_submit_urb(urb, GFP_ATOMIC);
 757         if (r < 0)
 758                 printk(KERN_ERR "go7007-usb: error in video pipe: %d\n", r);
 759 }
 760
 761 static void go7007_usb_read_audio_pipe_complete(struct urb *urb)
 762 {
 763         struct go7007 *go = (struct go7007 *)urb->context;
 764         int r, status = urb->status;
 765
 766         if (!go->streaming)
 767                 return;
 768         if (status) {
 769                 printk(KERN_ERR "go7007-usb: error in audio pipe: %d\n",
 770                         status);
 771                 return;
 772         }
 773         if (urb->actual_length != urb->transfer_buffer_length) {
 774                 printk(KERN_ERR "go7007-usb: short read in audio pipe!\n");
 775                 return;
 776         }
 777         if (go->audio_deliver != NULL)
 778                 go->audio_deliver(go, urb->transfer_buffer, urb->actual_length);
 779         r = usb_submit_urb(urb, GFP_ATOMIC);
 780         if (r < 0)
 781                 printk(KERN_ERR "go7007-usb: error in audio pipe: %d\n", r);
 782 }
 783
 784 static int go7007_usb_stream_start(struct go7007 *go)
 785 {
 786         struct go7007_usb *usb = go->hpi_context;
 787         int i, r;
 788
 789         for (i = 0; i < 8; ++i) {
 790                 r = usb_submit_urb(usb->video_urbs[i], GFP_KERNEL);
 791                 if (r < 0) {
 792                         printk(KERN_ERR "go7007-usb: error submitting video "
 793                                         "urb %d: %d\n", i, r);
 794                         goto video_submit_failed;
 795                 }
 796         }
 797         if (!go->audio_enabled)
 798                 return 0;
 799
 800         for (i = 0; i < 8; ++i) {
 801                 r = usb_submit_urb(usb->audio_urbs[i], GFP_KERNEL);
 802                 if (r < 0) {
 803                         printk(KERN_ERR "go7007-usb: error submitting audio "
 804                                         "urb %d: %d\n", i, r);
 805                         goto audio_submit_failed;
 806                 }
 807         }
 808         return 0;
 809
 810 audio_submit_failed:
 811         for (i = 0; i < 7; ++i)
 812                 usb_kill_urb(usb->audio_urbs[i]);
 813 video_submit_failed:
 814         for (i = 0; i < 8; ++i)
 815                 usb_kill_urb(usb->video_urbs[i]);
 816         return -1;
 817 }
 818
 819 static int go7007_usb_stream_stop(struct go7007 *go)
 820 {
 821         struct go7007_usb *usb = go->hpi_context;
 822         int i;
 823
 824         if (go->status == STATUS_SHUTDOWN)
 825                 return 0;
 826         for (i = 0; i < 8; ++i)
 827                 usb_kill_urb(usb->video_urbs[i]);
 828         if (go->audio_enabled)
 829                 for (i = 0; i < 8; ++i)
 830                         usb_kill_urb(usb->audio_urbs[i]);
 831         return 0;
 832 }
 833
 834 static int go7007_usb_send_firmware(struct go7007 *go, u8 *data, int len)
 835 {
 836         struct go7007_usb *usb = go->hpi_context;
 837         int transferred, pipe;
 838         int timeout = 500;
 839
 840 #ifdef GO7007_USB_DEBUG
 841         printk(KERN_DEBUG "go7007-usb: DownloadBuffer sending %d bytes\n", len);
 842 #endif
 843
 844         if (usb->board->flags & GO7007_USB_EZUSB)
 845                 pipe = usb_sndbulkpipe(usb->usbdev, 2);
 846         else
 847                 pipe = usb_sndbulkpipe(usb->usbdev, 3);
 848
 849         return usb_bulk_msg(usb->usbdev, pipe, data, len,
 850                                         &transferred, timeout);
 851 }
 852
 853 static struct go7007_hpi_ops go7007_usb_ezusb_hpi_ops = {
 854         .interface_reset        = go7007_usb_interface_reset,
 855         .write_interrupt        = go7007_usb_ezusb_write_interrupt,
 856         .read_interrupt         = go7007_usb_read_interrupt,
 857         .stream_start           = go7007_usb_stream_start,
 858         .stream_stop            = go7007_usb_stream_stop,
 859         .send_firmware          = go7007_usb_send_firmware,
 860 };
 861
 862 static struct go7007_hpi_ops go7007_usb_onboard_hpi_ops = {
 863         .interface_reset        = go7007_usb_interface_reset,
 864         .write_interrupt        = go7007_usb_onboard_write_interrupt,
 865         .read_interrupt         = go7007_usb_read_interrupt,
 866         .stream_start           = go7007_usb_stream_start,
 867         .stream_stop            = go7007_usb_stream_stop,
 868         .send_firmware          = go7007_usb_send_firmware,
 869 };
 870
 871 /********************* Driver for EZ-USB I2C adapter *********************/
 872
 873 static int go7007_usb_i2c_master_xfer(struct i2c_adapter *adapter,
 874                                         struct i2c_msg msgs[], int num)
 875 {
 876         struct go7007 *go = i2c_get_adapdata(adapter);
 877         struct go7007_usb *usb = go->hpi_context;
 878         u8 buf[16];
 879         int buf_len, i;
 880         int ret = -1;
 881
 882         if (go->status == STATUS_SHUTDOWN)
 883                 return -1;
 884
 885         mutex_lock(&usb->i2c_lock);
 886
 887         for (i = 0; i < num; ++i) {
 888                 /* The hardware command is "write some bytes then read some
 889                  * bytes", so we try to coalesce a write followed by a read
 890                  * into a single USB transaction */
 891                 if (i + 1 < num && msgs[i].addr == msgs[i + 1].addr &&
 892                                 !(msgs[i].flags & I2C_M_RD) &&
 893                                 (msgs[i + 1].flags & I2C_M_RD)) {
 894 #ifdef GO7007_I2C_DEBUG
 895                         printk(KERN_DEBUG "go7007-usb: i2c write/read %d/%d "
 896                                         "bytes on %02x\n", msgs[i].len,
 897                                         msgs[i + 1].len, msgs[i].addr);
 898 #endif
 899                         buf[0] = 0x01;
 900                         buf[1] = msgs[i].len + 1;
 901                         buf[2] = msgs[i].addr << 1;
 902                         memcpy(&buf[3], msgs[i].buf, msgs[i].len);
 903                         buf_len = msgs[i].len + 3;
 904                         buf[buf_len++] = msgs[++i].len;
 905                 } else if (msgs[i].flags & I2C_M_RD) {
 906 #ifdef GO7007_I2C_DEBUG
 907                         printk(KERN_DEBUG "go7007-usb: i2c read %d "
 908                                         "bytes on %02x\n", msgs[i].len,
 909                                         msgs[i].addr);
 910 #endif
 911                         buf[0] = 0x01;
 912                         buf[1] = 1;
 913                         buf[2] = msgs[i].addr << 1;
 914                         buf[3] = msgs[i].len;
 915                         buf_len = 4;
 916                 } else {
 917 #ifdef GO7007_I2C_DEBUG
 918                         printk(KERN_DEBUG "go7007-usb: i2c write %d "
 919                                         "bytes on %02x\n", msgs[i].len,
 920                                         msgs[i].addr);
 921 #endif
 922                         buf[0] = 0x00;
 923                         buf[1] = msgs[i].len + 1;
 924                         buf[2] = msgs[i].addr << 1;
 925                         memcpy(&buf[3], msgs[i].buf, msgs[i].len);
 926                         buf_len = msgs[i].len + 3;
 927                         buf[buf_len++] = 0;
 928                 }
 929                 if (go7007_usb_vendor_request(go, 0x24, 0, 0,
 930                                                 buf, buf_len, 0) < 0)
 931                         goto i2c_done;
 932                 if (msgs[i].flags & I2C_M_RD) {
 933                         memset(buf, 0, sizeof(buf));
 934                         if (go7007_usb_vendor_request(go, 0x25, 0, 0, buf,
 935                                                 msgs[i].len + 1, 1) < 0)
 936                                 goto i2c_done;
 937                         memcpy(msgs[i].buf, buf + 1, msgs[i].len);
 938                 }
 939         }
 940         ret = 0;
 941
 942 i2c_done:
 943         mutex_unlock(&usb->i2c_lock);
 944         return ret;
 945 }
 946
 947 static u32 go7007_usb_functionality(struct i2c_adapter *adapter)
 948 {
 949         /* No errors are reported by the hardware, so we don't bother
 950          * supporting quick writes to avoid confusing probing */
 951         return (I2C_FUNC_SMBUS_EMUL) & ~I2C_FUNC_SMBUS_QUICK;
 952 }
 953
 954 static struct i2c_algorithm go7007_usb_algo = {
 955         .master_xfer    = go7007_usb_i2c_master_xfer,
 956         .functionality  = go7007_usb_functionality,
 957 };
 958
 959 static struct i2c_adapter go7007_usb_adap_templ = {
 960         .owner                  = THIS_MODULE,
 961         .name                   = "WIS GO7007SB EZ-USB",
 962         .algo                   = &go7007_usb_algo,
 963 };
 964
 965 /********************* USB add/remove functions *********************/
 966
 967 static int go7007_usb_probe(struct usb_interface *intf,
 968                 const struct usb_device_id *id)
 969 {
 970         struct go7007 *go;
 971         struct go7007_usb *usb;
 972         struct go7007_usb_board *board;
 973         struct usb_device *usbdev = interface_to_usbdev(intf);
 974         char *name;
 975         int video_pipe, i, v_urb_len;
 976
 977         printk(KERN_DEBUG "go7007-usb: probing new GO7007 USB board\n");
 978
 979         switch (id->driver_info) {
 980         case GO7007_BOARDID_MATRIX_II:
 981                 name = "WIS Matrix II or compatible";
 982                 board = &board_matrix_ii;
 983                 break;
 984         case GO7007_BOARDID_MATRIX_RELOAD:
 985                 name = "WIS Matrix Reloaded or compatible";
 986                 board = &board_matrix_reload;
 987                 break;
 988         case GO7007_BOARDID_MATRIX_REV:
 989                 name = "WIS Matrix Revolution or compatible";
 990                 board = &board_matrix_revolution;
 991                 break;
 992         case GO7007_BOARDID_STAR_TREK:
 993                 name = "WIS Star Trek or compatible";
 994                 board = &board_star_trek;
 995                 break;
 996         case GO7007_BOARDID_XMEN:
 997                 name = "WIS XMen or compatible";
 998                 board = &board_xmen;
 999                 break;
1000         case GO7007_BOARDID_XMEN_II:
1001                 name = "WIS XMen II or compatible";
1002                 board = &board_xmen;
1003                 break;
1004         case GO7007_BOARDID_XMEN_III:
1005                 name = "WIS XMen III or compatible";
1006                 board = &board_xmen;
1007                 break;
1008         case GO7007_BOARDID_PX_M402U:
1009                 name = "Plextor PX-M402U";
1010                 board = &board_matrix_ii;
1011                 break;
1012         case GO7007_BOARDID_PX_TV402U_ANY:
1013                 name = "Plextor PX-TV402U (unknown tuner)";
1014                 board = &board_px_tv402u;
1015                 break;
1016         case GO7007_BOARDID_LIFEVIEW_LR192:
1017                 printk(KERN_ERR "go7007-usb: The Lifeview TV Walker Ultra "
1018                                 "is not supported.  Sorry!\n");
1019                 return 0;
1020                 name = "Lifeview TV Walker Ultra";
1021                 board = &board_lifeview_lr192;
1022                 break;
1023         case GO7007_BOARDID_SENSORAY_2250:
1024                 printk(KERN_INFO "Sensoray 2250 found\n");
1025                 name = "Sensoray 2250/2251";
1026                 board = &board_sensoray_2250;
1027                 break;
1028         default:
1029                 printk(KERN_ERR "go7007-usb: unknown board ID %d!\n",
1030                                 (unsigned int)id->driver_info);
1031                 return 0;
1032         }
1033
1034         usb = kzalloc(sizeof(struct go7007_usb), GFP_KERNEL);
1035         if (usb == NULL)
1036                 return -ENOMEM;
1037
1038         /* Allocate the URB and buffer for receiving incoming interrupts */
1039         usb->intr_urb = usb_alloc_urb(0, GFP_KERNEL);
1040         if (usb->intr_urb == NULL)
1041                 goto allocfail;
1042         usb->intr_urb->transfer_buffer = kmalloc(2*sizeof(u16), GFP_KERNEL);
1043         if (usb->intr_urb->transfer_buffer == NULL)
1044                 goto allocfail;
1045
1046         go = go7007_alloc(&board->main_info, &intf->dev);
1047         if (go == NULL)
1048                 goto allocfail;
1049         usb->board = board;
1050         usb->usbdev = usbdev;
1051         go->board_id = id->driver_info;
1052         strncpy(go->name, name, sizeof(go->name));
1053         if (board->flags & GO7007_USB_EZUSB)
1054                 go->hpi_ops = &go7007_usb_ezusb_hpi_ops;
1055         else
1056                 go->hpi_ops = &go7007_usb_onboard_hpi_ops;
1057         go->hpi_context = usb;
1058         usb_fill_int_urb(usb->intr_urb, usb->usbdev,
1059                         usb_rcvintpipe(usb->usbdev, 4),
1060                         usb->intr_urb->transfer_buffer, 2*sizeof(u16),
1061                         go7007_usb_readinterrupt_complete, go, 8);
1062         usb_set_intfdata(intf, &go->v4l2_dev);
1063
1064         /* Boot the GO7007 */
1065         if (go7007_boot_encoder(go, go->board_info->flags &
1066                                         GO7007_BOARD_USE_ONBOARD_I2C) < 0)
1067                 goto initfail;
1068
1069         /* Register the EZ-USB I2C adapter, if we're using it */
1070         if (board->flags & GO7007_USB_EZUSB_I2C) {
1071                 memcpy(&go->i2c_adapter, &go7007_usb_adap_templ,
1072                                 sizeof(go7007_usb_adap_templ));
1073                 mutex_init(&usb->i2c_lock);
1074                 go->i2c_adapter.dev.parent = go->dev;
1075                 i2c_set_adapdata(&go->i2c_adapter, go);
1076                 if (i2c_add_adapter(&go->i2c_adapter) < 0) {
1077                         printk(KERN_ERR
1078                                 "go7007-usb: error: i2c_add_adapter failed\n");
1079                         goto initfail;
1080                 }
1081                 go->i2c_adapter_online = 1;
1082         }
1083
1084         /* Pelco and Adlink reused the XMen and XMen-III vendor and product
1085          * IDs for their own incompatible designs.  We can detect XMen boards
1086          * by probing the sensor, but there is no way to probe the sensors on
1087          * the Pelco and Adlink designs so we default to the Adlink.  If it
1088          * is actually a Pelco, the user must set the assume_endura module
1089          * parameter. */
1090         if ((go->board_id == GO7007_BOARDID_XMEN ||
1091                                 go->board_id == GO7007_BOARDID_XMEN_III) &&
1092                         go->i2c_adapter_online) {
1093                 union i2c_smbus_data data;
1094
1095                 /* Check to see if register 0x0A is 0x76 */
1096                 i2c_smbus_xfer(&go->i2c_adapter, 0x21, I2C_CLIENT_SCCB,
1097                         I2C_SMBUS_READ, 0x0A, I2C_SMBUS_BYTE_DATA, &data);
1098                 if (data.byte != 0x76) {
1099                         if (assume_endura) {
1100                                 go->board_id = GO7007_BOARDID_ENDURA;
1101                                 usb->board = board = &board_endura;
1102                                 go->board_info = &board->main_info;
1103                                 strncpy(go->name, "Pelco Endura",
1104                                         sizeof(go->name));
1105                         } else {
1106                                 u16 channel;
1107
1108                                 /* set GPIO5 to be an output, currently low */
1109                                 go7007_write_addr(go, 0x3c82, 0x0000);
1110                                 go7007_write_addr(go, 0x3c80, 0x00df);
1111                                 /* read channel number from GPIO[1:0] */
1112                                 go7007_read_addr(go, 0x3c81, &channel);
1113                                 channel &= 0x3;
1114                                 go->board_id = GO7007_BOARDID_ADLINK_MPG24;
1115                                 usb->board = board = &board_adlink_mpg24;
1116                                 go->board_info = &board->main_info;
1117                                 go->channel_number = channel;
1118                                 snprintf(go->name, sizeof(go->name),
1119                                         "Adlink PCI-MPG24, channel #%d",
1120                                         channel);
1121                         }
1122                 }
1123         }
1124
1125         /* Probe the tuner model on the TV402U */
1126         if (go->board_id == GO7007_BOARDID_PX_TV402U_ANY) {
1127                 u8 data[3];
1128
1129                 /* Board strapping indicates tuner model */
1130                 if (go7007_usb_vendor_request(go, 0x41, 0, 0, data, 3, 1) < 0) {
1131                         printk(KERN_ERR "go7007-usb: GPIO read failed!\n");
1132                         goto initfail;
1133                 }
1134                 switch (data[0] >> 6) {
1135                 case 1:
1136                         go->board_id = GO7007_BOARDID_PX_TV402U_EU;
1137                         go->tuner_type = TUNER_SONY_BTF_PG472Z;
1138                         strncpy(go->name, "Plextor PX-TV402U-EU",
1139                                         sizeof(go->name));
1140                         break;
1141                 case 2:
1142                         go->board_id = GO7007_BOARDID_PX_TV402U_JP;
1143                         go->tuner_type = TUNER_SONY_BTF_PK467Z;
1144                         strncpy(go->name, "Plextor PX-TV402U-JP",
1145                                         sizeof(go->name));
1146                         break;
1147                 case 3:
1148                         go->board_id = GO7007_BOARDID_PX_TV402U_NA;
1149                         go->tuner_type = TUNER_SONY_BTF_PB463Z;
1150                         strncpy(go->name, "Plextor PX-TV402U-NA",
1151                                         sizeof(go->name));
1152                         break;
1153                 default:
1154                         printk(KERN_DEBUG "go7007-usb: unable to detect "
1155                                                 "tuner type!\n");
1156                         break;
1157                 }
1158                 /* Configure tuner mode selection inputs connected
1159                  * to the EZ-USB GPIO output pins */
1160                 if (go7007_usb_vendor_request(go, 0x40, 0x7f02, 0,
1161                                         NULL, 0, 0) < 0) {
1162                         printk(KERN_ERR "go7007-usb: GPIO write failed!\n");
1163                         goto initfail;
1164                 }
1165         }
1166
1167         /* Print a nasty message if the user attempts to use a USB2.0 device in
1168          * a USB1.1 port.  There will be silent corruption of the stream. */
1169         if ((board->flags & GO7007_USB_EZUSB) &&
1170                         usbdev->speed != USB_SPEED_HIGH)
1171                 printk(KERN_ERR "go7007-usb: *** WARNING ***  This device "
1172                                 "must be connected to a USB 2.0 port!  "
1173                                 "Attempting to capture video through a USB 1.1 "
1174                                 "port will result in stream corruption, even "
1175                                 "at low bitrates!\n");
1176
1177         /* Do any final GO7007 initialization, then register the
1178          * V4L2 and ALSA interfaces */
1179         if (go7007_register_encoder(go) < 0)
1180                 goto initfail;
1181
1182         /* Allocate the URBs and buffers for receiving the video stream */
1183         if (board->flags & GO7007_USB_EZUSB) {
1184                 v_urb_len = 1024;
1185                 video_pipe = usb_rcvbulkpipe(usb->usbdev, 6);
1186         } else {
1187                 v_urb_len = 512;
1188                 video_pipe = usb_rcvbulkpipe(usb->usbdev, 1);
1189         }
1190         for (i = 0; i < 8; ++i) {
1191                 usb->video_urbs[i] = usb_alloc_urb(0, GFP_KERNEL);
1192                 if (usb->video_urbs[i] == NULL)
1193                         goto initfail;
1194                 usb->video_urbs[i]->transfer_buffer =
1195                                                 kmalloc(v_urb_len, GFP_KERNEL);
1196                 if (usb->video_urbs[i]->transfer_buffer == NULL)
1197                         goto initfail;
1198                 usb_fill_bulk_urb(usb->video_urbs[i], usb->usbdev, video_pipe,
1199                                 usb->video_urbs[i]->transfer_buffer, v_urb_len,
1200                                 go7007_usb_read_video_pipe_complete, go);
1201         }
1202
1203         /* Allocate the URBs and buffers for receiving the audio stream */
1204         if ((board->flags & GO7007_USB_EZUSB) && go->audio_enabled)
1205                 for (i = 0; i < 8; ++i) {
1206                         usb->audio_urbs[i] = usb_alloc_urb(0, GFP_KERNEL);
1207                         if (usb->audio_urbs[i] == NULL)
1208                                 goto initfail;
1209                         usb->audio_urbs[i]->transfer_buffer = kmalloc(4096,
1210                                                                 GFP_KERNEL);
1211                         if (usb->audio_urbs[i]->transfer_buffer == NULL)
1212                                 goto initfail;
1213                         usb_fill_bulk_urb(usb->audio_urbs[i], usb->usbdev,
1214                                 usb_rcvbulkpipe(usb->usbdev, 8),
1215                                 usb->audio_urbs[i]->transfer_buffer, 4096,
1216                                 go7007_usb_read_audio_pipe_complete, go);
1217                 }
1218
1219
1220         go->status = STATUS_ONLINE;
1221         return 0;
1222
1223 initfail:
1224         go->status = STATUS_SHUTDOWN;
1225         return 0;
1226
1227 allocfail:
1228         if (usb->intr_urb) {
1229                 kfree(usb->intr_urb->transfer_buffer);
1230                 usb_free_urb(usb->intr_urb);
1231         }
1232         kfree(usb);
1233         return -ENOMEM;
1234 }
1235
1236 static void go7007_usb_disconnect(struct usb_interface *intf)
1237 {
1238         struct go7007 *go = to_go7007(usb_get_intfdata(intf));
1239         struct go7007_usb *usb = go->hpi_context;
1240         struct urb *vurb, *aurb;
1241         int i;
1242
1243         go->status = STATUS_SHUTDOWN;
1244         usb_kill_urb(usb->intr_urb);
1245
1246         /* Free USB-related structs */
1247         for (i = 0; i < 8; ++i) {
1248                 vurb = usb->video_urbs[i];
1249                 if (vurb) {
1250                         usb_kill_urb(vurb);
1251                         if (vurb->transfer_buffer)
1252                                 kfree(vurb->transfer_buffer);
1253                         usb_free_urb(vurb);
1254                 }
1255                 aurb = usb->audio_urbs[i];
1256                 if (aurb) {
1257                         usb_kill_urb(aurb);
1258                         if (aurb->transfer_buffer)
1259                                 kfree(aurb->transfer_buffer);
1260                         usb_free_urb(aurb);
1261                 }
1262         }
1263         kfree(usb->intr_urb->transfer_buffer);
1264         usb_free_urb(usb->intr_urb);
1265
1266         kfree(go->hpi_context);
1267
1268         go7007_remove(go);
1269 }
1270
1271 static struct usb_driver go7007_usb_driver = {
1272         .name           = "go7007",
1273         .probe          = go7007_usb_probe,
1274         .disconnect     = go7007_usb_disconnect,
1275         .id_table       = go7007_usb_id_table,
1276 };
1277
1278 static int __init go7007_usb_init(void)
1279 {
1280         return usb_register(&go7007_usb_driver);
1281 }
1282
1283 static void __exit go7007_usb_cleanup(void)
1284 {
1285         usb_deregister(&go7007_usb_driver);
1286 }
1287
1288 module_init(go7007_usb_init);
1289 module_exit(go7007_usb_cleanup);
1290
1291 MODULE_LICENSE("GPL v2");