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