0001
0002
0003
0004
0005
0006 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
0007
0008 #include <linux/module.h>
0009 #include <linux/kernel.h>
0010 #include <linux/wait.h>
0011 #include <linux/list.h>
0012 #include <linux/slab.h>
0013 #include <linux/time.h>
0014 #include <linux/mm.h>
0015 #include <linux/usb.h>
0016 #include <linux/i2c.h>
0017 #include <asm/byteorder.h>
0018 #include <media/i2c/saa7115.h>
0019 #include <media/tuner.h>
0020 #include <media/i2c/uda1342.h>
0021
0022 #include "go7007-priv.h"
0023
0024 static unsigned int assume_endura;
0025 module_param(assume_endura, int, 0644);
0026 MODULE_PARM_DESC(assume_endura,
0027 "when probing fails, hardware is a Pelco Endura");
0028
0029
0030
0031 #define HPI_STATUS_ADDR 0xFFF4
0032 #define INT_PARAM_ADDR 0xFFF6
0033 #define INT_INDEX_ADDR 0xFFF8
0034
0035
0036
0037
0038
0039
0040
0041
0042
0043
0044
0045 #define GO7007_USB_EZUSB (1<<0)
0046 #define GO7007_USB_EZUSB_I2C (1<<1)
0047
0048 struct go7007_usb_board {
0049 unsigned int flags;
0050 struct go7007_board_info main_info;
0051 };
0052
0053 struct go7007_usb {
0054 const struct go7007_usb_board *board;
0055 struct mutex i2c_lock;
0056 struct usb_device *usbdev;
0057 struct urb *video_urbs[8];
0058 struct urb *audio_urbs[8];
0059 struct urb *intr_urb;
0060 };
0061
0062
0063
0064 static const struct go7007_usb_board board_matrix_ii = {
0065 .flags = GO7007_USB_EZUSB,
0066 .main_info = {
0067 .flags = GO7007_BOARD_HAS_AUDIO |
0068 GO7007_BOARD_USE_ONBOARD_I2C,
0069 .audio_flags = GO7007_AUDIO_I2S_MODE_1 |
0070 GO7007_AUDIO_WORD_16,
0071 .audio_rate = 48000,
0072 .audio_bclk_div = 8,
0073 .audio_main_div = 2,
0074 .hpi_buffer_cap = 7,
0075 .sensor_flags = GO7007_SENSOR_656 |
0076 GO7007_SENSOR_VALID_ENABLE |
0077 GO7007_SENSOR_TV |
0078 GO7007_SENSOR_SAA7115 |
0079 GO7007_SENSOR_VBI |
0080 GO7007_SENSOR_SCALING,
0081 .num_i2c_devs = 1,
0082 .i2c_devs = {
0083 {
0084 .type = "saa7115",
0085 .addr = 0x20,
0086 .is_video = 1,
0087 },
0088 },
0089 .num_inputs = 2,
0090 .inputs = {
0091 {
0092 .video_input = 0,
0093 .name = "Composite",
0094 },
0095 {
0096 .video_input = 9,
0097 .name = "S-Video",
0098 },
0099 },
0100 .video_config = SAA7115_IDQ_IS_DEFAULT,
0101 },
0102 };
0103
0104 static const struct go7007_usb_board board_matrix_reload = {
0105 .flags = GO7007_USB_EZUSB,
0106 .main_info = {
0107 .flags = GO7007_BOARD_HAS_AUDIO |
0108 GO7007_BOARD_USE_ONBOARD_I2C,
0109 .audio_flags = GO7007_AUDIO_I2S_MODE_1 |
0110 GO7007_AUDIO_I2S_MASTER |
0111 GO7007_AUDIO_WORD_16,
0112 .audio_rate = 48000,
0113 .audio_bclk_div = 8,
0114 .audio_main_div = 2,
0115 .hpi_buffer_cap = 7,
0116 .sensor_flags = GO7007_SENSOR_656 |
0117 GO7007_SENSOR_TV,
0118 .num_i2c_devs = 1,
0119 .i2c_devs = {
0120 {
0121 .type = "saa7113",
0122 .addr = 0x25,
0123 .is_video = 1,
0124 },
0125 },
0126 .num_inputs = 2,
0127 .inputs = {
0128 {
0129 .video_input = 0,
0130 .name = "Composite",
0131 },
0132 {
0133 .video_input = 9,
0134 .name = "S-Video",
0135 },
0136 },
0137 .video_config = SAA7115_IDQ_IS_DEFAULT,
0138 },
0139 };
0140
0141 static const struct go7007_usb_board board_star_trek = {
0142 .flags = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C,
0143 .main_info = {
0144 .flags = GO7007_BOARD_HAS_AUDIO,
0145
0146 .sensor_flags = GO7007_SENSOR_656 |
0147 GO7007_SENSOR_VALID_ENABLE |
0148 GO7007_SENSOR_TV |
0149 GO7007_SENSOR_SAA7115 |
0150 GO7007_SENSOR_VBI |
0151 GO7007_SENSOR_SCALING,
0152 .audio_flags = GO7007_AUDIO_I2S_MODE_1 |
0153 GO7007_AUDIO_WORD_16,
0154 .audio_bclk_div = 8,
0155 .audio_main_div = 2,
0156 .hpi_buffer_cap = 7,
0157 .num_i2c_devs = 1,
0158 .i2c_devs = {
0159 {
0160 .type = "saa7115",
0161 .addr = 0x20,
0162 .is_video = 1,
0163 },
0164 },
0165 .num_inputs = 2,
0166 .inputs = {
0167
0168
0169
0170
0171
0172
0173 {
0174 .video_input = 1,
0175
0176 .name = "Composite",
0177 },
0178 {
0179 .video_input = 8,
0180
0181 .name = "S-Video",
0182 },
0183 },
0184 .video_config = SAA7115_IDQ_IS_DEFAULT,
0185 },
0186 };
0187
0188 static const struct go7007_usb_board board_px_tv402u = {
0189 .flags = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C,
0190 .main_info = {
0191 .flags = GO7007_BOARD_HAS_AUDIO |
0192 GO7007_BOARD_HAS_TUNER,
0193 .sensor_flags = GO7007_SENSOR_656 |
0194 GO7007_SENSOR_VALID_ENABLE |
0195 GO7007_SENSOR_TV |
0196 GO7007_SENSOR_SAA7115 |
0197 GO7007_SENSOR_VBI |
0198 GO7007_SENSOR_SCALING,
0199 .audio_flags = GO7007_AUDIO_I2S_MODE_1 |
0200 GO7007_AUDIO_WORD_16,
0201 .audio_bclk_div = 8,
0202 .audio_main_div = 2,
0203 .hpi_buffer_cap = 7,
0204 .num_i2c_devs = 5,
0205 .i2c_devs = {
0206 {
0207 .type = "saa7115",
0208 .addr = 0x20,
0209 .is_video = 1,
0210 },
0211 {
0212 .type = "uda1342",
0213 .addr = 0x1a,
0214 .is_audio = 1,
0215 },
0216 {
0217 .type = "tuner",
0218 .addr = 0x60,
0219 },
0220 {
0221 .type = "tuner",
0222 .addr = 0x43,
0223 },
0224 {
0225 .type = "sony-btf-mpx",
0226 .addr = 0x44,
0227 },
0228 },
0229 .num_inputs = 3,
0230 .inputs = {
0231 {
0232 .video_input = 3,
0233 .audio_index = 0,
0234 .name = "Tuner",
0235 },
0236 {
0237 .video_input = 1,
0238 .audio_index = 1,
0239 .name = "Composite",
0240 },
0241 {
0242 .video_input = 8,
0243 .audio_index = 1,
0244 .name = "S-Video",
0245 },
0246 },
0247 .video_config = SAA7115_IDQ_IS_DEFAULT,
0248 .num_aud_inputs = 2,
0249 .aud_inputs = {
0250 {
0251 .audio_input = UDA1342_IN2,
0252 .name = "Tuner",
0253 },
0254 {
0255 .audio_input = UDA1342_IN1,
0256 .name = "Line In",
0257 },
0258 },
0259 },
0260 };
0261
0262 static const struct go7007_usb_board board_xmen = {
0263 .flags = 0,
0264 .main_info = {
0265 .flags = GO7007_BOARD_USE_ONBOARD_I2C,
0266 .hpi_buffer_cap = 0,
0267 .sensor_flags = GO7007_SENSOR_VREF_POLAR,
0268 .sensor_width = 320,
0269 .sensor_height = 240,
0270 .sensor_framerate = 30030,
0271 .audio_flags = GO7007_AUDIO_ONE_CHANNEL |
0272 GO7007_AUDIO_I2S_MODE_3 |
0273 GO7007_AUDIO_WORD_14 |
0274 GO7007_AUDIO_I2S_MASTER |
0275 GO7007_AUDIO_BCLK_POLAR |
0276 GO7007_AUDIO_OKI_MODE,
0277 .audio_rate = 8000,
0278 .audio_bclk_div = 48,
0279 .audio_main_div = 1,
0280 .num_i2c_devs = 1,
0281 .i2c_devs = {
0282 {
0283 .type = "ov7640",
0284 .addr = 0x21,
0285 },
0286 },
0287 .num_inputs = 1,
0288 .inputs = {
0289 {
0290 .name = "Camera",
0291 },
0292 },
0293 },
0294 };
0295
0296 static const struct go7007_usb_board board_matrix_revolution = {
0297 .flags = GO7007_USB_EZUSB,
0298 .main_info = {
0299 .flags = GO7007_BOARD_HAS_AUDIO |
0300 GO7007_BOARD_USE_ONBOARD_I2C,
0301 .audio_flags = GO7007_AUDIO_I2S_MODE_1 |
0302 GO7007_AUDIO_I2S_MASTER |
0303 GO7007_AUDIO_WORD_16,
0304 .audio_rate = 48000,
0305 .audio_bclk_div = 8,
0306 .audio_main_div = 2,
0307 .hpi_buffer_cap = 7,
0308 .sensor_flags = GO7007_SENSOR_656 |
0309 GO7007_SENSOR_TV |
0310 GO7007_SENSOR_VBI,
0311 .num_i2c_devs = 1,
0312 .i2c_devs = {
0313 {
0314 .type = "tw9903",
0315 .is_video = 1,
0316 .addr = 0x44,
0317 },
0318 },
0319 .num_inputs = 2,
0320 .inputs = {
0321 {
0322 .video_input = 2,
0323 .name = "Composite",
0324 },
0325 {
0326 .video_input = 8,
0327 .name = "S-Video",
0328 },
0329 },
0330 },
0331 };
0332
0333 #if 0
0334 static const struct go7007_usb_board board_lifeview_lr192 = {
0335 .flags = GO7007_USB_EZUSB,
0336 .main_info = {
0337 .flags = GO7007_BOARD_HAS_AUDIO |
0338 GO7007_BOARD_USE_ONBOARD_I2C,
0339 .audio_flags = GO7007_AUDIO_I2S_MODE_1 |
0340 GO7007_AUDIO_WORD_16,
0341 .audio_rate = 48000,
0342 .audio_bclk_div = 8,
0343 .audio_main_div = 2,
0344 .hpi_buffer_cap = 7,
0345 .sensor_flags = GO7007_SENSOR_656 |
0346 GO7007_SENSOR_VALID_ENABLE |
0347 GO7007_SENSOR_TV |
0348 GO7007_SENSOR_VBI |
0349 GO7007_SENSOR_SCALING,
0350 .num_i2c_devs = 0,
0351 .num_inputs = 1,
0352 .inputs = {
0353 {
0354 .video_input = 0,
0355 .name = "Composite",
0356 },
0357 },
0358 },
0359 };
0360 #endif
0361
0362 static const struct go7007_usb_board board_endura = {
0363 .flags = 0,
0364 .main_info = {
0365 .flags = 0,
0366 .audio_flags = GO7007_AUDIO_I2S_MODE_1 |
0367 GO7007_AUDIO_I2S_MASTER |
0368 GO7007_AUDIO_WORD_16,
0369 .audio_rate = 8000,
0370 .audio_bclk_div = 48,
0371 .audio_main_div = 8,
0372 .hpi_buffer_cap = 0,
0373 .sensor_flags = GO7007_SENSOR_656 |
0374 GO7007_SENSOR_TV,
0375 .sensor_h_offset = 8,
0376 .num_i2c_devs = 0,
0377 .num_inputs = 1,
0378 .inputs = {
0379 {
0380 .name = "Camera",
0381 },
0382 },
0383 },
0384 };
0385
0386 static const struct go7007_usb_board board_adlink_mpg24 = {
0387 .flags = 0,
0388 .main_info = {
0389 .flags = GO7007_BOARD_USE_ONBOARD_I2C,
0390 .audio_flags = GO7007_AUDIO_I2S_MODE_1 |
0391 GO7007_AUDIO_I2S_MASTER |
0392 GO7007_AUDIO_WORD_16,
0393 .audio_rate = 48000,
0394 .audio_bclk_div = 8,
0395 .audio_main_div = 2,
0396 .hpi_buffer_cap = 0,
0397 .sensor_flags = GO7007_SENSOR_656 |
0398 GO7007_SENSOR_TV |
0399 GO7007_SENSOR_VBI,
0400 .num_i2c_devs = 1,
0401 .i2c_devs = {
0402 {
0403 .type = "tw2804",
0404 .addr = 0x00,
0405 .flags = I2C_CLIENT_TEN,
0406 .is_video = 1,
0407 },
0408 },
0409 .num_inputs = 1,
0410 .inputs = {
0411 {
0412 .name = "Composite",
0413 },
0414 },
0415 },
0416 };
0417
0418 static const struct go7007_usb_board board_sensoray_2250 = {
0419 .flags = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C,
0420 .main_info = {
0421 .audio_flags = GO7007_AUDIO_I2S_MODE_1 |
0422 GO7007_AUDIO_I2S_MASTER |
0423 GO7007_AUDIO_WORD_16,
0424 .flags = GO7007_BOARD_HAS_AUDIO,
0425 .audio_rate = 48000,
0426 .audio_bclk_div = 8,
0427 .audio_main_div = 2,
0428 .hpi_buffer_cap = 7,
0429 .sensor_flags = GO7007_SENSOR_656 |
0430 GO7007_SENSOR_TV,
0431 .num_i2c_devs = 1,
0432 .i2c_devs = {
0433 {
0434 .type = "s2250",
0435 .addr = 0x43,
0436 .is_video = 1,
0437 .is_audio = 1,
0438 },
0439 },
0440 .num_inputs = 2,
0441 .inputs = {
0442 {
0443 .video_input = 0,
0444 .name = "Composite",
0445 },
0446 {
0447 .video_input = 1,
0448 .name = "S-Video",
0449 },
0450 },
0451 .num_aud_inputs = 3,
0452 .aud_inputs = {
0453 {
0454 .audio_input = 0,
0455 .name = "Line In",
0456 },
0457 {
0458 .audio_input = 1,
0459 .name = "Mic",
0460 },
0461 {
0462 .audio_input = 2,
0463 .name = "Mic Boost",
0464 },
0465 },
0466 },
0467 };
0468
0469 static const struct go7007_usb_board board_ads_usbav_709 = {
0470 .flags = GO7007_USB_EZUSB,
0471 .main_info = {
0472 .flags = GO7007_BOARD_HAS_AUDIO |
0473 GO7007_BOARD_USE_ONBOARD_I2C,
0474 .audio_flags = GO7007_AUDIO_I2S_MODE_1 |
0475 GO7007_AUDIO_I2S_MASTER |
0476 GO7007_AUDIO_WORD_16,
0477 .audio_rate = 48000,
0478 .audio_bclk_div = 8,
0479 .audio_main_div = 2,
0480 .hpi_buffer_cap = 7,
0481 .sensor_flags = GO7007_SENSOR_656 |
0482 GO7007_SENSOR_TV |
0483 GO7007_SENSOR_VBI,
0484 .num_i2c_devs = 1,
0485 .i2c_devs = {
0486 {
0487 .type = "tw9906",
0488 .is_video = 1,
0489 .addr = 0x44,
0490 },
0491 },
0492 .num_inputs = 2,
0493 .inputs = {
0494 {
0495 .video_input = 0,
0496 .name = "Composite",
0497 },
0498 {
0499 .video_input = 10,
0500 .name = "S-Video",
0501 },
0502 },
0503 },
0504 };
0505
0506 static const struct usb_device_id go7007_usb_id_table[] = {
0507 {
0508 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION |
0509 USB_DEVICE_ID_MATCH_INT_INFO,
0510 .idVendor = 0x0eb1,
0511 .idProduct = 0x7007,
0512 .bcdDevice_lo = 0x200,
0513 .bcdDevice_hi = 0x200,
0514 .bInterfaceClass = 255,
0515 .bInterfaceSubClass = 0,
0516 .bInterfaceProtocol = 255,
0517 .driver_info = (kernel_ulong_t)GO7007_BOARDID_XMEN,
0518 },
0519 {
0520 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
0521 .idVendor = 0x0eb1,
0522 .idProduct = 0x7007,
0523 .bcdDevice_lo = 0x202,
0524 .bcdDevice_hi = 0x202,
0525 .driver_info = (kernel_ulong_t)GO7007_BOARDID_MATRIX_II,
0526 },
0527 {
0528 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
0529 .idVendor = 0x0eb1,
0530 .idProduct = 0x7007,
0531 .bcdDevice_lo = 0x204,
0532 .bcdDevice_hi = 0x204,
0533 .driver_info = (kernel_ulong_t)GO7007_BOARDID_MATRIX_RELOAD,
0534 },
0535 {
0536 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION |
0537 USB_DEVICE_ID_MATCH_INT_INFO,
0538 .idVendor = 0x0eb1,
0539 .idProduct = 0x7007,
0540 .bcdDevice_lo = 0x205,
0541 .bcdDevice_hi = 0x205,
0542 .bInterfaceClass = 255,
0543 .bInterfaceSubClass = 0,
0544 .bInterfaceProtocol = 255,
0545 .driver_info = (kernel_ulong_t)GO7007_BOARDID_XMEN_II,
0546 },
0547 {
0548 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
0549 .idVendor = 0x0eb1,
0550 .idProduct = 0x7007,
0551 .bcdDevice_lo = 0x208,
0552 .bcdDevice_hi = 0x208,
0553 .driver_info = (kernel_ulong_t)GO7007_BOARDID_STAR_TREK,
0554 },
0555 {
0556 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION |
0557 USB_DEVICE_ID_MATCH_INT_INFO,
0558 .idVendor = 0x0eb1,
0559 .idProduct = 0x7007,
0560 .bcdDevice_lo = 0x209,
0561 .bcdDevice_hi = 0x209,
0562 .bInterfaceClass = 255,
0563 .bInterfaceSubClass = 0,
0564 .bInterfaceProtocol = 255,
0565 .driver_info = (kernel_ulong_t)GO7007_BOARDID_XMEN_III,
0566 },
0567 {
0568 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
0569 .idVendor = 0x0eb1,
0570 .idProduct = 0x7007,
0571 .bcdDevice_lo = 0x210,
0572 .bcdDevice_hi = 0x210,
0573 .driver_info = (kernel_ulong_t)GO7007_BOARDID_MATRIX_REV,
0574 },
0575 {
0576 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
0577 .idVendor = 0x093b,
0578 .idProduct = 0xa102,
0579 .bcdDevice_lo = 0x1,
0580 .bcdDevice_hi = 0x1,
0581 .driver_info = (kernel_ulong_t)GO7007_BOARDID_PX_M402U,
0582 },
0583 {
0584 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
0585 .idVendor = 0x093b,
0586 .idProduct = 0xa104,
0587 .bcdDevice_lo = 0x1,
0588 .bcdDevice_hi = 0x1,
0589 .driver_info = (kernel_ulong_t)GO7007_BOARDID_PX_TV402U,
0590 },
0591 {
0592 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
0593 .idVendor = 0x10fd,
0594 .idProduct = 0xde00,
0595 .bcdDevice_lo = 0x1,
0596 .bcdDevice_hi = 0x1,
0597 .driver_info = (kernel_ulong_t)GO7007_BOARDID_LIFEVIEW_LR192,
0598 },
0599 {
0600 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
0601 .idVendor = 0x1943,
0602 .idProduct = 0x2250,
0603 .bcdDevice_lo = 0x1,
0604 .bcdDevice_hi = 0x1,
0605 .driver_info = (kernel_ulong_t)GO7007_BOARDID_SENSORAY_2250,
0606 },
0607 {
0608 .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION,
0609 .idVendor = 0x06e1,
0610 .idProduct = 0x0709,
0611 .bcdDevice_lo = 0x204,
0612 .bcdDevice_hi = 0x204,
0613 .driver_info = (kernel_ulong_t)GO7007_BOARDID_ADS_USBAV_709,
0614 },
0615 { }
0616 };
0617
0618 MODULE_DEVICE_TABLE(usb, go7007_usb_id_table);
0619
0620
0621
0622 static int go7007_usb_vendor_request(struct go7007 *go, int request,
0623 int value, int index, void *transfer_buffer, int length, int in)
0624 {
0625 struct go7007_usb *usb = go->hpi_context;
0626 int timeout = 5000;
0627
0628 if (in) {
0629 return usb_control_msg(usb->usbdev,
0630 usb_rcvctrlpipe(usb->usbdev, 0), request,
0631 USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
0632 value, index, transfer_buffer, length, timeout);
0633 } else {
0634 return usb_control_msg(usb->usbdev,
0635 usb_sndctrlpipe(usb->usbdev, 0), request,
0636 USB_TYPE_VENDOR | USB_RECIP_DEVICE,
0637 value, index, transfer_buffer, length, timeout);
0638 }
0639 }
0640
0641 static int go7007_usb_interface_reset(struct go7007 *go)
0642 {
0643 struct go7007_usb *usb = go->hpi_context;
0644 u16 intr_val, intr_data;
0645
0646 if (go->status == STATUS_SHUTDOWN)
0647 return -1;
0648
0649 if (go7007_write_interrupt(go, 0x0001, 0x0001) < 0)
0650 return -1;
0651 msleep(100);
0652
0653 if (usb->board->flags & GO7007_USB_EZUSB) {
0654
0655 pr_debug("resetting EZ-USB buffers\n");
0656 if (go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0 ||
0657 go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0)
0658 return -1;
0659
0660
0661 if (go7007_write_interrupt(go, 0x0001, 0x0001) < 0)
0662 return -1;
0663 msleep(100);
0664 }
0665
0666
0667 if (go7007_read_interrupt(go, &intr_val, &intr_data) < 0 ||
0668 (intr_val & ~0x1) != 0x55aa) {
0669 dev_err(go->dev, "unable to reset the USB interface\n");
0670 return -1;
0671 }
0672 return 0;
0673 }
0674
0675 static int go7007_usb_ezusb_write_interrupt(struct go7007 *go,
0676 int addr, int data)
0677 {
0678 struct go7007_usb *usb = go->hpi_context;
0679 int i, r;
0680 u16 status_reg = 0;
0681 int timeout = 500;
0682
0683 pr_debug("WriteInterrupt: %04x %04x\n", addr, data);
0684
0685 for (i = 0; i < 100; ++i) {
0686 r = usb_control_msg(usb->usbdev,
0687 usb_rcvctrlpipe(usb->usbdev, 0), 0x14,
0688 USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
0689 0, HPI_STATUS_ADDR, go->usb_buf,
0690 sizeof(status_reg), timeout);
0691 if (r < 0)
0692 break;
0693 status_reg = le16_to_cpu(*((__le16 *)go->usb_buf));
0694 if (!(status_reg & 0x0010))
0695 break;
0696 msleep(10);
0697 }
0698 if (r < 0)
0699 goto write_int_error;
0700 if (i == 100) {
0701 dev_err(go->dev, "device is hung, status reg = 0x%04x\n", status_reg);
0702 return -1;
0703 }
0704 r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 0), 0x12,
0705 USB_TYPE_VENDOR | USB_RECIP_DEVICE, data,
0706 INT_PARAM_ADDR, NULL, 0, timeout);
0707 if (r < 0)
0708 goto write_int_error;
0709 r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 0),
0710 0x12, USB_TYPE_VENDOR | USB_RECIP_DEVICE, addr,
0711 INT_INDEX_ADDR, NULL, 0, timeout);
0712 if (r < 0)
0713 goto write_int_error;
0714 return 0;
0715
0716 write_int_error:
0717 dev_err(go->dev, "error in WriteInterrupt: %d\n", r);
0718 return r;
0719 }
0720
0721 static int go7007_usb_onboard_write_interrupt(struct go7007 *go,
0722 int addr, int data)
0723 {
0724 struct go7007_usb *usb = go->hpi_context;
0725 int r;
0726 int timeout = 500;
0727
0728 pr_debug("WriteInterrupt: %04x %04x\n", addr, data);
0729
0730 go->usb_buf[0] = data & 0xff;
0731 go->usb_buf[1] = data >> 8;
0732 go->usb_buf[2] = addr & 0xff;
0733 go->usb_buf[3] = addr >> 8;
0734 go->usb_buf[4] = go->usb_buf[5] = go->usb_buf[6] = go->usb_buf[7] = 0;
0735 r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 2), 0x00,
0736 USB_TYPE_VENDOR | USB_RECIP_ENDPOINT, 0x55aa,
0737 0xf0f0, go->usb_buf, 8, timeout);
0738 if (r < 0) {
0739 dev_err(go->dev, "error in WriteInterrupt: %d\n", r);
0740 return r;
0741 }
0742 return 0;
0743 }
0744
0745 static void go7007_usb_readinterrupt_complete(struct urb *urb)
0746 {
0747 struct go7007 *go = (struct go7007 *)urb->context;
0748 __le16 *regs = (__le16 *)urb->transfer_buffer;
0749 int status = urb->status;
0750
0751 if (status) {
0752 if (status != -ESHUTDOWN &&
0753 go->status != STATUS_SHUTDOWN) {
0754 dev_err(go->dev, "error in read interrupt: %d\n", urb->status);
0755 } else {
0756 wake_up(&go->interrupt_waitq);
0757 return;
0758 }
0759 } else if (urb->actual_length != urb->transfer_buffer_length) {
0760 dev_err(go->dev, "short read in interrupt pipe!\n");
0761 } else {
0762 go->interrupt_available = 1;
0763 go->interrupt_data = __le16_to_cpu(regs[0]);
0764 go->interrupt_value = __le16_to_cpu(regs[1]);
0765 pr_debug("ReadInterrupt: %04x %04x\n",
0766 go->interrupt_value, go->interrupt_data);
0767 }
0768
0769 wake_up(&go->interrupt_waitq);
0770 }
0771
0772 static int go7007_usb_read_interrupt(struct go7007 *go)
0773 {
0774 struct go7007_usb *usb = go->hpi_context;
0775 int r;
0776
0777 r = usb_submit_urb(usb->intr_urb, GFP_KERNEL);
0778 if (r < 0) {
0779 dev_err(go->dev, "unable to submit interrupt urb: %d\n", r);
0780 return r;
0781 }
0782 return 0;
0783 }
0784
0785 static void go7007_usb_read_video_pipe_complete(struct urb *urb)
0786 {
0787 struct go7007 *go = (struct go7007 *)urb->context;
0788 int r, status = urb->status;
0789
0790 if (!vb2_is_streaming(&go->vidq)) {
0791 wake_up_interruptible(&go->frame_waitq);
0792 return;
0793 }
0794 if (status) {
0795 dev_err(go->dev, "error in video pipe: %d\n", status);
0796 return;
0797 }
0798 if (urb->actual_length != urb->transfer_buffer_length) {
0799 dev_err(go->dev, "short read in video pipe!\n");
0800 return;
0801 }
0802 go7007_parse_video_stream(go, urb->transfer_buffer, urb->actual_length);
0803 r = usb_submit_urb(urb, GFP_ATOMIC);
0804 if (r < 0)
0805 dev_err(go->dev, "error in video pipe: %d\n", r);
0806 }
0807
0808 static void go7007_usb_read_audio_pipe_complete(struct urb *urb)
0809 {
0810 struct go7007 *go = (struct go7007 *)urb->context;
0811 int r, status = urb->status;
0812
0813 if (!vb2_is_streaming(&go->vidq))
0814 return;
0815 if (status) {
0816 dev_err(go->dev, "error in audio pipe: %d\n",
0817 status);
0818 return;
0819 }
0820 if (urb->actual_length != urb->transfer_buffer_length) {
0821 dev_err(go->dev, "short read in audio pipe!\n");
0822 return;
0823 }
0824 if (go->audio_deliver != NULL)
0825 go->audio_deliver(go, urb->transfer_buffer, urb->actual_length);
0826 r = usb_submit_urb(urb, GFP_ATOMIC);
0827 if (r < 0)
0828 dev_err(go->dev, "error in audio pipe: %d\n", r);
0829 }
0830
0831 static int go7007_usb_stream_start(struct go7007 *go)
0832 {
0833 struct go7007_usb *usb = go->hpi_context;
0834 int i, r;
0835
0836 for (i = 0; i < 8; ++i) {
0837 r = usb_submit_urb(usb->video_urbs[i], GFP_KERNEL);
0838 if (r < 0) {
0839 dev_err(go->dev, "error submitting video urb %d: %d\n", i, r);
0840 goto video_submit_failed;
0841 }
0842 }
0843 if (!go->audio_enabled)
0844 return 0;
0845
0846 for (i = 0; i < 8; ++i) {
0847 r = usb_submit_urb(usb->audio_urbs[i], GFP_KERNEL);
0848 if (r < 0) {
0849 dev_err(go->dev, "error submitting audio urb %d: %d\n", i, r);
0850 goto audio_submit_failed;
0851 }
0852 }
0853 return 0;
0854
0855 audio_submit_failed:
0856 for (i = 0; i < 7; ++i)
0857 usb_kill_urb(usb->audio_urbs[i]);
0858 video_submit_failed:
0859 for (i = 0; i < 8; ++i)
0860 usb_kill_urb(usb->video_urbs[i]);
0861 return -1;
0862 }
0863
0864 static int go7007_usb_stream_stop(struct go7007 *go)
0865 {
0866 struct go7007_usb *usb = go->hpi_context;
0867 int i;
0868
0869 if (go->status == STATUS_SHUTDOWN)
0870 return 0;
0871 for (i = 0; i < 8; ++i)
0872 usb_kill_urb(usb->video_urbs[i]);
0873 if (go->audio_enabled)
0874 for (i = 0; i < 8; ++i)
0875 usb_kill_urb(usb->audio_urbs[i]);
0876 return 0;
0877 }
0878
0879 static int go7007_usb_send_firmware(struct go7007 *go, u8 *data, int len)
0880 {
0881 struct go7007_usb *usb = go->hpi_context;
0882 int transferred, pipe;
0883 int timeout = 500;
0884
0885 pr_debug("DownloadBuffer sending %d bytes\n", len);
0886
0887 if (usb->board->flags & GO7007_USB_EZUSB)
0888 pipe = usb_sndbulkpipe(usb->usbdev, 2);
0889 else
0890 pipe = usb_sndbulkpipe(usb->usbdev, 3);
0891
0892 return usb_bulk_msg(usb->usbdev, pipe, data, len,
0893 &transferred, timeout);
0894 }
0895
0896 static void go7007_usb_release(struct go7007 *go)
0897 {
0898 struct go7007_usb *usb = go->hpi_context;
0899 struct urb *vurb, *aurb;
0900 int i;
0901
0902 if (usb->intr_urb) {
0903 usb_kill_urb(usb->intr_urb);
0904 kfree(usb->intr_urb->transfer_buffer);
0905 usb_free_urb(usb->intr_urb);
0906 }
0907
0908
0909 for (i = 0; i < 8; ++i) {
0910 vurb = usb->video_urbs[i];
0911 if (vurb) {
0912 usb_kill_urb(vurb);
0913 kfree(vurb->transfer_buffer);
0914 usb_free_urb(vurb);
0915 }
0916 aurb = usb->audio_urbs[i];
0917 if (aurb) {
0918 usb_kill_urb(aurb);
0919 kfree(aurb->transfer_buffer);
0920 usb_free_urb(aurb);
0921 }
0922 }
0923
0924 kfree(go->hpi_context);
0925 }
0926
0927 static const struct go7007_hpi_ops go7007_usb_ezusb_hpi_ops = {
0928 .interface_reset = go7007_usb_interface_reset,
0929 .write_interrupt = go7007_usb_ezusb_write_interrupt,
0930 .read_interrupt = go7007_usb_read_interrupt,
0931 .stream_start = go7007_usb_stream_start,
0932 .stream_stop = go7007_usb_stream_stop,
0933 .send_firmware = go7007_usb_send_firmware,
0934 .release = go7007_usb_release,
0935 };
0936
0937 static const struct go7007_hpi_ops go7007_usb_onboard_hpi_ops = {
0938 .interface_reset = go7007_usb_interface_reset,
0939 .write_interrupt = go7007_usb_onboard_write_interrupt,
0940 .read_interrupt = go7007_usb_read_interrupt,
0941 .stream_start = go7007_usb_stream_start,
0942 .stream_stop = go7007_usb_stream_stop,
0943 .send_firmware = go7007_usb_send_firmware,
0944 .release = go7007_usb_release,
0945 };
0946
0947
0948
0949 static int go7007_usb_i2c_master_xfer(struct i2c_adapter *adapter,
0950 struct i2c_msg msgs[], int num)
0951 {
0952 struct go7007 *go = i2c_get_adapdata(adapter);
0953 struct go7007_usb *usb = go->hpi_context;
0954 u8 *buf = go->usb_buf;
0955 int buf_len, i;
0956 int ret = -EIO;
0957
0958 if (go->status == STATUS_SHUTDOWN)
0959 return -ENODEV;
0960
0961 mutex_lock(&usb->i2c_lock);
0962
0963 for (i = 0; i < num; ++i) {
0964
0965
0966
0967 if (i + 1 < num && msgs[i].addr == msgs[i + 1].addr &&
0968 !(msgs[i].flags & I2C_M_RD) &&
0969 (msgs[i + 1].flags & I2C_M_RD)) {
0970 #ifdef GO7007_I2C_DEBUG
0971 pr_debug("i2c write/read %d/%d bytes on %02x\n",
0972 msgs[i].len, msgs[i + 1].len, msgs[i].addr);
0973 #endif
0974 buf[0] = 0x01;
0975 buf[1] = msgs[i].len + 1;
0976 buf[2] = msgs[i].addr << 1;
0977 memcpy(&buf[3], msgs[i].buf, msgs[i].len);
0978 buf_len = msgs[i].len + 3;
0979 buf[buf_len++] = msgs[++i].len;
0980 } else if (msgs[i].flags & I2C_M_RD) {
0981 #ifdef GO7007_I2C_DEBUG
0982 pr_debug("i2c read %d bytes on %02x\n",
0983 msgs[i].len, msgs[i].addr);
0984 #endif
0985 buf[0] = 0x01;
0986 buf[1] = 1;
0987 buf[2] = msgs[i].addr << 1;
0988 buf[3] = msgs[i].len;
0989 buf_len = 4;
0990 } else {
0991 #ifdef GO7007_I2C_DEBUG
0992 pr_debug("i2c write %d bytes on %02x\n",
0993 msgs[i].len, msgs[i].addr);
0994 #endif
0995 buf[0] = 0x00;
0996 buf[1] = msgs[i].len + 1;
0997 buf[2] = msgs[i].addr << 1;
0998 memcpy(&buf[3], msgs[i].buf, msgs[i].len);
0999 buf_len = msgs[i].len + 3;
1000 buf[buf_len++] = 0;
1001 }
1002 if (go7007_usb_vendor_request(go, 0x24, 0, 0,
1003 buf, buf_len, 0) < 0)
1004 goto i2c_done;
1005 if (msgs[i].flags & I2C_M_RD) {
1006 memset(buf, 0, msgs[i].len + 1);
1007 if (go7007_usb_vendor_request(go, 0x25, 0, 0, buf,
1008 msgs[i].len + 1, 1) < 0)
1009 goto i2c_done;
1010 memcpy(msgs[i].buf, buf + 1, msgs[i].len);
1011 }
1012 }
1013 ret = num;
1014
1015 i2c_done:
1016 mutex_unlock(&usb->i2c_lock);
1017 return ret;
1018 }
1019
1020 static u32 go7007_usb_functionality(struct i2c_adapter *adapter)
1021 {
1022
1023
1024 return (I2C_FUNC_SMBUS_EMUL) & ~I2C_FUNC_SMBUS_QUICK;
1025 }
1026
1027 static const struct i2c_algorithm go7007_usb_algo = {
1028 .master_xfer = go7007_usb_i2c_master_xfer,
1029 .functionality = go7007_usb_functionality,
1030 };
1031
1032 static struct i2c_adapter go7007_usb_adap_templ = {
1033 .owner = THIS_MODULE,
1034 .name = "WIS GO7007SB EZ-USB",
1035 .algo = &go7007_usb_algo,
1036 };
1037
1038
1039
1040 static int go7007_usb_probe(struct usb_interface *intf,
1041 const struct usb_device_id *id)
1042 {
1043 struct go7007 *go;
1044 struct go7007_usb *usb;
1045 const struct go7007_usb_board *board;
1046 struct usb_device *usbdev = interface_to_usbdev(intf);
1047 struct usb_host_endpoint *ep;
1048 unsigned num_i2c_devs;
1049 char *name;
1050 int video_pipe, i, v_urb_len;
1051
1052 pr_debug("probing new GO7007 USB board\n");
1053
1054 switch (id->driver_info) {
1055 case GO7007_BOARDID_MATRIX_II:
1056 name = "WIS Matrix II or compatible";
1057 board = &board_matrix_ii;
1058 break;
1059 case GO7007_BOARDID_MATRIX_RELOAD:
1060 name = "WIS Matrix Reloaded or compatible";
1061 board = &board_matrix_reload;
1062 break;
1063 case GO7007_BOARDID_MATRIX_REV:
1064 name = "WIS Matrix Revolution or compatible";
1065 board = &board_matrix_revolution;
1066 break;
1067 case GO7007_BOARDID_STAR_TREK:
1068 name = "WIS Star Trek or compatible";
1069 board = &board_star_trek;
1070 break;
1071 case GO7007_BOARDID_XMEN:
1072 name = "WIS XMen or compatible";
1073 board = &board_xmen;
1074 break;
1075 case GO7007_BOARDID_XMEN_II:
1076 name = "WIS XMen II or compatible";
1077 board = &board_xmen;
1078 break;
1079 case GO7007_BOARDID_XMEN_III:
1080 name = "WIS XMen III or compatible";
1081 board = &board_xmen;
1082 break;
1083 case GO7007_BOARDID_PX_M402U:
1084 name = "Plextor PX-M402U";
1085 board = &board_matrix_ii;
1086 break;
1087 case GO7007_BOARDID_PX_TV402U:
1088 name = "Plextor PX-TV402U (unknown tuner)";
1089 board = &board_px_tv402u;
1090 break;
1091 case GO7007_BOARDID_LIFEVIEW_LR192:
1092 dev_err(&intf->dev, "The Lifeview TV Walker Ultra is not supported. Sorry!\n");
1093 return -ENODEV;
1094 #if 0
1095 name = "Lifeview TV Walker Ultra";
1096 board = &board_lifeview_lr192;
1097 #endif
1098 break;
1099 case GO7007_BOARDID_SENSORAY_2250:
1100 dev_info(&intf->dev, "Sensoray 2250 found\n");
1101 name = "Sensoray 2250/2251";
1102 board = &board_sensoray_2250;
1103 break;
1104 case GO7007_BOARDID_ADS_USBAV_709:
1105 name = "ADS Tech DVD Xpress DX2";
1106 board = &board_ads_usbav_709;
1107 break;
1108 default:
1109 dev_err(&intf->dev, "unknown board ID %d!\n",
1110 (unsigned int)id->driver_info);
1111 return -ENODEV;
1112 }
1113
1114 go = go7007_alloc(&board->main_info, &intf->dev);
1115 if (go == NULL)
1116 return -ENOMEM;
1117
1118 usb = kzalloc(sizeof(struct go7007_usb), GFP_KERNEL);
1119 if (usb == NULL) {
1120 kfree(go);
1121 return -ENOMEM;
1122 }
1123
1124 usb->board = board;
1125 usb->usbdev = usbdev;
1126 usb_make_path(usbdev, go->bus_info, sizeof(go->bus_info));
1127 go->board_id = id->driver_info;
1128 strscpy(go->name, name, sizeof(go->name));
1129 if (board->flags & GO7007_USB_EZUSB)
1130 go->hpi_ops = &go7007_usb_ezusb_hpi_ops;
1131 else
1132 go->hpi_ops = &go7007_usb_onboard_hpi_ops;
1133 go->hpi_context = usb;
1134
1135 ep = usb->usbdev->ep_in[4];
1136 if (!ep)
1137 goto allocfail;
1138
1139
1140 usb->intr_urb = usb_alloc_urb(0, GFP_KERNEL);
1141 if (usb->intr_urb == NULL)
1142 goto allocfail;
1143 usb->intr_urb->transfer_buffer = kmalloc_array(2, sizeof(u16),
1144 GFP_KERNEL);
1145 if (usb->intr_urb->transfer_buffer == NULL)
1146 goto allocfail;
1147
1148 if (usb_endpoint_type(&ep->desc) == USB_ENDPOINT_XFER_BULK)
1149 usb_fill_bulk_urb(usb->intr_urb, usb->usbdev,
1150 usb_rcvbulkpipe(usb->usbdev, 4),
1151 usb->intr_urb->transfer_buffer, 2*sizeof(u16),
1152 go7007_usb_readinterrupt_complete, go);
1153 else
1154 usb_fill_int_urb(usb->intr_urb, usb->usbdev,
1155 usb_rcvintpipe(usb->usbdev, 4),
1156 usb->intr_urb->transfer_buffer, 2*sizeof(u16),
1157 go7007_usb_readinterrupt_complete, go, 8);
1158 usb_set_intfdata(intf, &go->v4l2_dev);
1159
1160
1161 if (go7007_boot_encoder(go, go->board_info->flags &
1162 GO7007_BOARD_USE_ONBOARD_I2C) < 0)
1163 goto allocfail;
1164
1165
1166 if (board->flags & GO7007_USB_EZUSB_I2C) {
1167 memcpy(&go->i2c_adapter, &go7007_usb_adap_templ,
1168 sizeof(go7007_usb_adap_templ));
1169 mutex_init(&usb->i2c_lock);
1170 go->i2c_adapter.dev.parent = go->dev;
1171 i2c_set_adapdata(&go->i2c_adapter, go);
1172 if (i2c_add_adapter(&go->i2c_adapter) < 0) {
1173 dev_err(go->dev, "error: i2c_add_adapter failed\n");
1174 goto allocfail;
1175 }
1176 go->i2c_adapter_online = 1;
1177 }
1178
1179
1180
1181
1182
1183
1184
1185 if ((go->board_id == GO7007_BOARDID_XMEN ||
1186 go->board_id == GO7007_BOARDID_XMEN_III) &&
1187 go->i2c_adapter_online) {
1188 union i2c_smbus_data data;
1189
1190
1191 i2c_smbus_xfer(&go->i2c_adapter, 0x21, I2C_CLIENT_SCCB,
1192 I2C_SMBUS_READ, 0x0A, I2C_SMBUS_BYTE_DATA, &data);
1193 if (data.byte != 0x76) {
1194 if (assume_endura) {
1195 go->board_id = GO7007_BOARDID_ENDURA;
1196 usb->board = board = &board_endura;
1197 go->board_info = &board->main_info;
1198 strscpy(go->name, "Pelco Endura",
1199 sizeof(go->name));
1200 } else {
1201 u16 channel;
1202
1203
1204 go7007_read_addr(go, 0x3c81, &channel);
1205 channel &= 0x3;
1206 go->board_id = GO7007_BOARDID_ADLINK_MPG24;
1207 usb->board = board = &board_adlink_mpg24;
1208 go->board_info = &board->main_info;
1209 go->channel_number = channel;
1210 snprintf(go->name, sizeof(go->name),
1211 "Adlink PCI-MPG24, channel #%d",
1212 channel);
1213 }
1214 go7007_update_board(go);
1215 }
1216 }
1217
1218 num_i2c_devs = go->board_info->num_i2c_devs;
1219
1220
1221 if (go->board_id == GO7007_BOARDID_PX_TV402U) {
1222
1223 if (go7007_usb_vendor_request(go, 0x41, 0, 0, go->usb_buf, 3,
1224 1) < 0) {
1225 dev_err(go->dev, "GPIO read failed!\n");
1226 goto allocfail;
1227 }
1228 switch (go->usb_buf[0] >> 6) {
1229 case 1:
1230 go->tuner_type = TUNER_SONY_BTF_PG472Z;
1231 go->std = V4L2_STD_PAL;
1232 strscpy(go->name, "Plextor PX-TV402U-EU",
1233 sizeof(go->name));
1234 break;
1235 case 2:
1236 go->tuner_type = TUNER_SONY_BTF_PK467Z;
1237 go->std = V4L2_STD_NTSC_M_JP;
1238 num_i2c_devs -= 2;
1239 strscpy(go->name, "Plextor PX-TV402U-JP",
1240 sizeof(go->name));
1241 break;
1242 case 3:
1243 go->tuner_type = TUNER_SONY_BTF_PB463Z;
1244 num_i2c_devs -= 2;
1245 strscpy(go->name, "Plextor PX-TV402U-NA",
1246 sizeof(go->name));
1247 break;
1248 default:
1249 pr_debug("unable to detect tuner type!\n");
1250 break;
1251 }
1252
1253
1254 if (go7007_usb_vendor_request(go, 0x40, 0x7f02, 0,
1255 NULL, 0, 0) < 0) {
1256 dev_err(go->dev, "GPIO write failed!\n");
1257 goto allocfail;
1258 }
1259 }
1260
1261
1262
1263 if ((board->flags & GO7007_USB_EZUSB) &&
1264 usbdev->speed != USB_SPEED_HIGH)
1265 dev_err(go->dev, "*** WARNING *** This device must be connected to a USB 2.0 port! Attempting to capture video through a USB 1.1 port will result in stream corruption, even at low bitrates!\n");
1266
1267
1268 if (board->flags & GO7007_USB_EZUSB) {
1269 if (!usb->usbdev->ep_in[6])
1270 goto allocfail;
1271 v_urb_len = 1024;
1272 video_pipe = usb_rcvbulkpipe(usb->usbdev, 6);
1273 } else {
1274 if (!usb->usbdev->ep_in[1])
1275 goto allocfail;
1276 v_urb_len = 512;
1277 video_pipe = usb_rcvbulkpipe(usb->usbdev, 1);
1278 }
1279 for (i = 0; i < 8; ++i) {
1280 usb->video_urbs[i] = usb_alloc_urb(0, GFP_KERNEL);
1281 if (usb->video_urbs[i] == NULL)
1282 goto allocfail;
1283 usb->video_urbs[i]->transfer_buffer =
1284 kmalloc(v_urb_len, GFP_KERNEL);
1285 if (usb->video_urbs[i]->transfer_buffer == NULL)
1286 goto allocfail;
1287 usb_fill_bulk_urb(usb->video_urbs[i], usb->usbdev, video_pipe,
1288 usb->video_urbs[i]->transfer_buffer, v_urb_len,
1289 go7007_usb_read_video_pipe_complete, go);
1290 }
1291
1292
1293 if ((board->flags & GO7007_USB_EZUSB) &&
1294 (board->main_info.flags & GO7007_BOARD_HAS_AUDIO)) {
1295 if (!usb->usbdev->ep_in[8])
1296 goto allocfail;
1297 for (i = 0; i < 8; ++i) {
1298 usb->audio_urbs[i] = usb_alloc_urb(0, GFP_KERNEL);
1299 if (usb->audio_urbs[i] == NULL)
1300 goto allocfail;
1301 usb->audio_urbs[i]->transfer_buffer = kmalloc(4096,
1302 GFP_KERNEL);
1303 if (usb->audio_urbs[i]->transfer_buffer == NULL)
1304 goto allocfail;
1305 usb_fill_bulk_urb(usb->audio_urbs[i], usb->usbdev,
1306 usb_rcvbulkpipe(usb->usbdev, 8),
1307 usb->audio_urbs[i]->transfer_buffer, 4096,
1308 go7007_usb_read_audio_pipe_complete, go);
1309 }
1310 }
1311
1312
1313
1314 if (go7007_register_encoder(go, num_i2c_devs) < 0)
1315 goto allocfail;
1316
1317 go->status = STATUS_ONLINE;
1318 return 0;
1319
1320 allocfail:
1321 go7007_usb_release(go);
1322 kfree(go);
1323 return -ENOMEM;
1324 }
1325
1326 static void go7007_usb_disconnect(struct usb_interface *intf)
1327 {
1328 struct go7007 *go = to_go7007(usb_get_intfdata(intf));
1329
1330 mutex_lock(&go->queue_lock);
1331 mutex_lock(&go->serialize_lock);
1332
1333 if (go->audio_enabled)
1334 go7007_snd_remove(go);
1335
1336 go->status = STATUS_SHUTDOWN;
1337 v4l2_device_disconnect(&go->v4l2_dev);
1338 video_unregister_device(&go->vdev);
1339 mutex_unlock(&go->serialize_lock);
1340 mutex_unlock(&go->queue_lock);
1341
1342 v4l2_device_put(&go->v4l2_dev);
1343 }
1344
1345 static struct usb_driver go7007_usb_driver = {
1346 .name = "go7007",
1347 .probe = go7007_usb_probe,
1348 .disconnect = go7007_usb_disconnect,
1349 .id_table = go7007_usb_id_table,
1350 };
1351
1352 module_usb_driver(go7007_usb_driver);
1353 MODULE_LICENSE("GPL v2");