| // SPDX-License-Identifier: GPL-2.0-only |
| /* |
| * Copyright (C) 2005-2006 Micronas USA Inc. |
| */ |
| |
| #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| |
| #include <linux/module.h> |
| #include <linux/kernel.h> |
| #include <linux/wait.h> |
| #include <linux/list.h> |
| #include <linux/slab.h> |
| #include <linux/time.h> |
| #include <linux/mm.h> |
| #include <linux/usb.h> |
| #include <linux/i2c.h> |
| #include <asm/byteorder.h> |
| #include <media/i2c/saa7115.h> |
| #include <media/tuner.h> |
| #include <media/i2c/uda1342.h> |
| |
| #include "go7007-priv.h" |
| |
| static unsigned int assume_endura; |
| module_param(assume_endura, int, 0644); |
| MODULE_PARM_DESC(assume_endura, |
| "when probing fails, hardware is a Pelco Endura"); |
| |
| /* #define GO7007_I2C_DEBUG */ /* for debugging the EZ-USB I2C adapter */ |
| |
| #define HPI_STATUS_ADDR 0xFFF4 |
| #define INT_PARAM_ADDR 0xFFF6 |
| #define INT_INDEX_ADDR 0xFFF8 |
| |
| /* |
| * Pipes on EZ-USB interface: |
| * 0 snd - Control |
| * 0 rcv - Control |
| * 2 snd - Download firmware (control) |
| * 4 rcv - Read Interrupt (interrupt) |
| * 6 rcv - Read Video (bulk) |
| * 8 rcv - Read Audio (bulk) |
| */ |
| |
| #define GO7007_USB_EZUSB (1<<0) |
| #define GO7007_USB_EZUSB_I2C (1<<1) |
| |
| struct go7007_usb_board { |
| unsigned int flags; |
| struct go7007_board_info main_info; |
| }; |
| |
| struct go7007_usb { |
| const struct go7007_usb_board *board; |
| struct mutex i2c_lock; |
| struct usb_device *usbdev; |
| struct urb *video_urbs[8]; |
| struct urb *audio_urbs[8]; |
| struct urb *intr_urb; |
| }; |
| |
| /*********************** Product specification data ***********************/ |
| |
| static const struct go7007_usb_board board_matrix_ii = { |
| .flags = GO7007_USB_EZUSB, |
| .main_info = { |
| .flags = GO7007_BOARD_HAS_AUDIO | |
| GO7007_BOARD_USE_ONBOARD_I2C, |
| .audio_flags = GO7007_AUDIO_I2S_MODE_1 | |
| GO7007_AUDIO_WORD_16, |
| .audio_rate = 48000, |
| .audio_bclk_div = 8, |
| .audio_main_div = 2, |
| .hpi_buffer_cap = 7, |
| .sensor_flags = GO7007_SENSOR_656 | |
| GO7007_SENSOR_VALID_ENABLE | |
| GO7007_SENSOR_TV | |
| GO7007_SENSOR_SAA7115 | |
| GO7007_SENSOR_VBI | |
| GO7007_SENSOR_SCALING, |
| .num_i2c_devs = 1, |
| .i2c_devs = { |
| { |
| .type = "saa7115", |
| .addr = 0x20, |
| .is_video = 1, |
| }, |
| }, |
| .num_inputs = 2, |
| .inputs = { |
| { |
| .video_input = 0, |
| .name = "Composite", |
| }, |
| { |
| .video_input = 9, |
| .name = "S-Video", |
| }, |
| }, |
| .video_config = SAA7115_IDQ_IS_DEFAULT, |
| }, |
| }; |
| |
| static const struct go7007_usb_board board_matrix_reload = { |
| .flags = GO7007_USB_EZUSB, |
| .main_info = { |
| .flags = GO7007_BOARD_HAS_AUDIO | |
| GO7007_BOARD_USE_ONBOARD_I2C, |
| .audio_flags = GO7007_AUDIO_I2S_MODE_1 | |
| GO7007_AUDIO_I2S_MASTER | |
| GO7007_AUDIO_WORD_16, |
| .audio_rate = 48000, |
| .audio_bclk_div = 8, |
| .audio_main_div = 2, |
| .hpi_buffer_cap = 7, |
| .sensor_flags = GO7007_SENSOR_656 | |
| GO7007_SENSOR_TV, |
| .num_i2c_devs = 1, |
| .i2c_devs = { |
| { |
| .type = "saa7113", |
| .addr = 0x25, |
| .is_video = 1, |
| }, |
| }, |
| .num_inputs = 2, |
| .inputs = { |
| { |
| .video_input = 0, |
| .name = "Composite", |
| }, |
| { |
| .video_input = 9, |
| .name = "S-Video", |
| }, |
| }, |
| .video_config = SAA7115_IDQ_IS_DEFAULT, |
| }, |
| }; |
| |
| static const struct go7007_usb_board board_star_trek = { |
| .flags = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C, |
| .main_info = { |
| .flags = GO7007_BOARD_HAS_AUDIO, /* | |
| GO7007_BOARD_HAS_TUNER, */ |
| .sensor_flags = GO7007_SENSOR_656 | |
| GO7007_SENSOR_VALID_ENABLE | |
| GO7007_SENSOR_TV | |
| GO7007_SENSOR_SAA7115 | |
| GO7007_SENSOR_VBI | |
| GO7007_SENSOR_SCALING, |
| .audio_flags = GO7007_AUDIO_I2S_MODE_1 | |
| GO7007_AUDIO_WORD_16, |
| .audio_bclk_div = 8, |
| .audio_main_div = 2, |
| .hpi_buffer_cap = 7, |
| .num_i2c_devs = 1, |
| .i2c_devs = { |
| { |
| .type = "saa7115", |
| .addr = 0x20, |
| .is_video = 1, |
| }, |
| }, |
| .num_inputs = 2, |
| .inputs = { |
| /* { |
| * .video_input = 3, |
| * .audio_index = AUDIO_TUNER, |
| * .name = "Tuner", |
| * }, |
| */ |
| { |
| .video_input = 1, |
| /* .audio_index = AUDIO_EXTERN, */ |
| .name = "Composite", |
| }, |
| { |
| .video_input = 8, |
| /* .audio_index = AUDIO_EXTERN, */ |
| .name = "S-Video", |
| }, |
| }, |
| .video_config = SAA7115_IDQ_IS_DEFAULT, |
| }, |
| }; |
| |
| static const struct go7007_usb_board board_px_tv402u = { |
| .flags = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C, |
| .main_info = { |
| .flags = GO7007_BOARD_HAS_AUDIO | |
| GO7007_BOARD_HAS_TUNER, |
| .sensor_flags = GO7007_SENSOR_656 | |
| GO7007_SENSOR_VALID_ENABLE | |
| GO7007_SENSOR_TV | |
| GO7007_SENSOR_SAA7115 | |
| GO7007_SENSOR_VBI | |
| GO7007_SENSOR_SCALING, |
| .audio_flags = GO7007_AUDIO_I2S_MODE_1 | |
| GO7007_AUDIO_WORD_16, |
| .audio_bclk_div = 8, |
| .audio_main_div = 2, |
| .hpi_buffer_cap = 7, |
| .num_i2c_devs = 5, |
| .i2c_devs = { |
| { |
| .type = "saa7115", |
| .addr = 0x20, |
| .is_video = 1, |
| }, |
| { |
| .type = "uda1342", |
| .addr = 0x1a, |
| .is_audio = 1, |
| }, |
| { |
| .type = "tuner", |
| .addr = 0x60, |
| }, |
| { |
| .type = "tuner", |
| .addr = 0x43, |
| }, |
| { |
| .type = "sony-btf-mpx", |
| .addr = 0x44, |
| }, |
| }, |
| .num_inputs = 3, |
| .inputs = { |
| { |
| .video_input = 3, |
| .audio_index = 0, |
| .name = "Tuner", |
| }, |
| { |
| .video_input = 1, |
| .audio_index = 1, |
| .name = "Composite", |
| }, |
| { |
| .video_input = 8, |
| .audio_index = 1, |
| .name = "S-Video", |
| }, |
| }, |
| .video_config = SAA7115_IDQ_IS_DEFAULT, |
| .num_aud_inputs = 2, |
| .aud_inputs = { |
| { |
| .audio_input = UDA1342_IN2, |
| .name = "Tuner", |
| }, |
| { |
| .audio_input = UDA1342_IN1, |
| .name = "Line In", |
| }, |
| }, |
| }, |
| }; |
| |
| static const struct go7007_usb_board board_xmen = { |
| .flags = 0, |
| .main_info = { |
| .flags = GO7007_BOARD_USE_ONBOARD_I2C, |
| .hpi_buffer_cap = 0, |
| .sensor_flags = GO7007_SENSOR_VREF_POLAR, |
| .sensor_width = 320, |
| .sensor_height = 240, |
| .sensor_framerate = 30030, |
| .audio_flags = GO7007_AUDIO_ONE_CHANNEL | |
| GO7007_AUDIO_I2S_MODE_3 | |
| GO7007_AUDIO_WORD_14 | |
| GO7007_AUDIO_I2S_MASTER | |
| GO7007_AUDIO_BCLK_POLAR | |
| GO7007_AUDIO_OKI_MODE, |
| .audio_rate = 8000, |
| .audio_bclk_div = 48, |
| .audio_main_div = 1, |
| .num_i2c_devs = 1, |
| .i2c_devs = { |
| { |
| .type = "ov7640", |
| .addr = 0x21, |
| }, |
| }, |
| .num_inputs = 1, |
| .inputs = { |
| { |
| .name = "Camera", |
| }, |
| }, |
| }, |
| }; |
| |
| static const struct go7007_usb_board board_matrix_revolution = { |
| .flags = GO7007_USB_EZUSB, |
| .main_info = { |
| .flags = GO7007_BOARD_HAS_AUDIO | |
| GO7007_BOARD_USE_ONBOARD_I2C, |
| .audio_flags = GO7007_AUDIO_I2S_MODE_1 | |
| GO7007_AUDIO_I2S_MASTER | |
| GO7007_AUDIO_WORD_16, |
| .audio_rate = 48000, |
| .audio_bclk_div = 8, |
| .audio_main_div = 2, |
| .hpi_buffer_cap = 7, |
| .sensor_flags = GO7007_SENSOR_656 | |
| GO7007_SENSOR_TV | |
| GO7007_SENSOR_VBI, |
| .num_i2c_devs = 1, |
| .i2c_devs = { |
| { |
| .type = "tw9903", |
| .is_video = 1, |
| .addr = 0x44, |
| }, |
| }, |
| .num_inputs = 2, |
| .inputs = { |
| { |
| .video_input = 2, |
| .name = "Composite", |
| }, |
| { |
| .video_input = 8, |
| .name = "S-Video", |
| }, |
| }, |
| }, |
| }; |
| |
| #if 0 |
| static const struct go7007_usb_board board_lifeview_lr192 = { |
| .flags = GO7007_USB_EZUSB, |
| .main_info = { |
| .flags = GO7007_BOARD_HAS_AUDIO | |
| GO7007_BOARD_USE_ONBOARD_I2C, |
| .audio_flags = GO7007_AUDIO_I2S_MODE_1 | |
| GO7007_AUDIO_WORD_16, |
| .audio_rate = 48000, |
| .audio_bclk_div = 8, |
| .audio_main_div = 2, |
| .hpi_buffer_cap = 7, |
| .sensor_flags = GO7007_SENSOR_656 | |
| GO7007_SENSOR_VALID_ENABLE | |
| GO7007_SENSOR_TV | |
| GO7007_SENSOR_VBI | |
| GO7007_SENSOR_SCALING, |
| .num_i2c_devs = 0, |
| .num_inputs = 1, |
| .inputs = { |
| { |
| .video_input = 0, |
| .name = "Composite", |
| }, |
| }, |
| }, |
| }; |
| #endif |
| |
| static const struct go7007_usb_board board_endura = { |
| .flags = 0, |
| .main_info = { |
| .flags = 0, |
| .audio_flags = GO7007_AUDIO_I2S_MODE_1 | |
| GO7007_AUDIO_I2S_MASTER | |
| GO7007_AUDIO_WORD_16, |
| .audio_rate = 8000, |
| .audio_bclk_div = 48, |
| .audio_main_div = 8, |
| .hpi_buffer_cap = 0, |
| .sensor_flags = GO7007_SENSOR_656 | |
| GO7007_SENSOR_TV, |
| .sensor_h_offset = 8, |
| .num_i2c_devs = 0, |
| .num_inputs = 1, |
| .inputs = { |
| { |
| .name = "Camera", |
| }, |
| }, |
| }, |
| }; |
| |
| static const struct go7007_usb_board board_adlink_mpg24 = { |
| .flags = 0, |
| .main_info = { |
| .flags = GO7007_BOARD_USE_ONBOARD_I2C, |
| .audio_flags = GO7007_AUDIO_I2S_MODE_1 | |
| GO7007_AUDIO_I2S_MASTER | |
| GO7007_AUDIO_WORD_16, |
| .audio_rate = 48000, |
| .audio_bclk_div = 8, |
| .audio_main_div = 2, |
| .hpi_buffer_cap = 0, |
| .sensor_flags = GO7007_SENSOR_656 | |
| GO7007_SENSOR_TV | |
| GO7007_SENSOR_VBI, |
| .num_i2c_devs = 1, |
| .i2c_devs = { |
| { |
| .type = "tw2804", |
| .addr = 0x00, /* yes, really */ |
| .flags = I2C_CLIENT_TEN, |
| .is_video = 1, |
| }, |
| }, |
| .num_inputs = 1, |
| .inputs = { |
| { |
| .name = "Composite", |
| }, |
| }, |
| }, |
| }; |
| |
| static const struct go7007_usb_board board_sensoray_2250 = { |
| .flags = GO7007_USB_EZUSB | GO7007_USB_EZUSB_I2C, |
| .main_info = { |
| .audio_flags = GO7007_AUDIO_I2S_MODE_1 | |
| GO7007_AUDIO_I2S_MASTER | |
| GO7007_AUDIO_WORD_16, |
| .flags = GO7007_BOARD_HAS_AUDIO, |
| .audio_rate = 48000, |
| .audio_bclk_div = 8, |
| .audio_main_div = 2, |
| .hpi_buffer_cap = 7, |
| .sensor_flags = GO7007_SENSOR_656 | |
| GO7007_SENSOR_TV, |
| .num_i2c_devs = 1, |
| .i2c_devs = { |
| { |
| .type = "s2250", |
| .addr = 0x43, |
| .is_video = 1, |
| .is_audio = 1, |
| }, |
| }, |
| .num_inputs = 2, |
| .inputs = { |
| { |
| .video_input = 0, |
| .name = "Composite", |
| }, |
| { |
| .video_input = 1, |
| .name = "S-Video", |
| }, |
| }, |
| .num_aud_inputs = 3, |
| .aud_inputs = { |
| { |
| .audio_input = 0, |
| .name = "Line In", |
| }, |
| { |
| .audio_input = 1, |
| .name = "Mic", |
| }, |
| { |
| .audio_input = 2, |
| .name = "Mic Boost", |
| }, |
| }, |
| }, |
| }; |
| |
| static const struct go7007_usb_board board_ads_usbav_709 = { |
| .flags = GO7007_USB_EZUSB, |
| .main_info = { |
| .flags = GO7007_BOARD_HAS_AUDIO | |
| GO7007_BOARD_USE_ONBOARD_I2C, |
| .audio_flags = GO7007_AUDIO_I2S_MODE_1 | |
| GO7007_AUDIO_I2S_MASTER | |
| GO7007_AUDIO_WORD_16, |
| .audio_rate = 48000, |
| .audio_bclk_div = 8, |
| .audio_main_div = 2, |
| .hpi_buffer_cap = 7, |
| .sensor_flags = GO7007_SENSOR_656 | |
| GO7007_SENSOR_TV | |
| GO7007_SENSOR_VBI, |
| .num_i2c_devs = 1, |
| .i2c_devs = { |
| { |
| .type = "tw9906", |
| .is_video = 1, |
| .addr = 0x44, |
| }, |
| }, |
| .num_inputs = 2, |
| .inputs = { |
| { |
| .video_input = 0, |
| .name = "Composite", |
| }, |
| { |
| .video_input = 10, |
| .name = "S-Video", |
| }, |
| }, |
| }, |
| }; |
| |
| static const struct usb_device_id go7007_usb_id_table[] = { |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION | |
| USB_DEVICE_ID_MATCH_INT_INFO, |
| .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ |
| .idProduct = 0x7007, /* Product ID of GO7007SB chip */ |
| .bcdDevice_lo = 0x200, /* Revision number of XMen */ |
| .bcdDevice_hi = 0x200, |
| .bInterfaceClass = 255, |
| .bInterfaceSubClass = 0, |
| .bInterfaceProtocol = 255, |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_XMEN, |
| }, |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, |
| .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ |
| .idProduct = 0x7007, /* Product ID of GO7007SB chip */ |
| .bcdDevice_lo = 0x202, /* Revision number of Matrix II */ |
| .bcdDevice_hi = 0x202, |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_MATRIX_II, |
| }, |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, |
| .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ |
| .idProduct = 0x7007, /* Product ID of GO7007SB chip */ |
| .bcdDevice_lo = 0x204, /* Revision number of Matrix */ |
| .bcdDevice_hi = 0x204, /* Reloaded */ |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_MATRIX_RELOAD, |
| }, |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION | |
| USB_DEVICE_ID_MATCH_INT_INFO, |
| .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ |
| .idProduct = 0x7007, /* Product ID of GO7007SB chip */ |
| .bcdDevice_lo = 0x205, /* Revision number of XMen-II */ |
| .bcdDevice_hi = 0x205, |
| .bInterfaceClass = 255, |
| .bInterfaceSubClass = 0, |
| .bInterfaceProtocol = 255, |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_XMEN_II, |
| }, |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, |
| .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ |
| .idProduct = 0x7007, /* Product ID of GO7007SB chip */ |
| .bcdDevice_lo = 0x208, /* Revision number of Star Trek */ |
| .bcdDevice_hi = 0x208, |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_STAR_TREK, |
| }, |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION | |
| USB_DEVICE_ID_MATCH_INT_INFO, |
| .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ |
| .idProduct = 0x7007, /* Product ID of GO7007SB chip */ |
| .bcdDevice_lo = 0x209, /* Revision number of XMen-III */ |
| .bcdDevice_hi = 0x209, |
| .bInterfaceClass = 255, |
| .bInterfaceSubClass = 0, |
| .bInterfaceProtocol = 255, |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_XMEN_III, |
| }, |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, |
| .idVendor = 0x0eb1, /* Vendor ID of WIS Technologies */ |
| .idProduct = 0x7007, /* Product ID of GO7007SB chip */ |
| .bcdDevice_lo = 0x210, /* Revision number of Matrix */ |
| .bcdDevice_hi = 0x210, /* Revolution */ |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_MATRIX_REV, |
| }, |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, |
| .idVendor = 0x093b, /* Vendor ID of Plextor */ |
| .idProduct = 0xa102, /* Product ID of M402U */ |
| .bcdDevice_lo = 0x1, /* revision number of Blueberry */ |
| .bcdDevice_hi = 0x1, |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_PX_M402U, |
| }, |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, |
| .idVendor = 0x093b, /* Vendor ID of Plextor */ |
| .idProduct = 0xa104, /* Product ID of TV402U */ |
| .bcdDevice_lo = 0x1, |
| .bcdDevice_hi = 0x1, |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_PX_TV402U, |
| }, |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, |
| .idVendor = 0x10fd, /* Vendor ID of Anubis Electronics */ |
| .idProduct = 0xde00, /* Product ID of Lifeview LR192 */ |
| .bcdDevice_lo = 0x1, |
| .bcdDevice_hi = 0x1, |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_LIFEVIEW_LR192, |
| }, |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, |
| .idVendor = 0x1943, /* Vendor ID Sensoray */ |
| .idProduct = 0x2250, /* Product ID of 2250/2251 */ |
| .bcdDevice_lo = 0x1, |
| .bcdDevice_hi = 0x1, |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_SENSORAY_2250, |
| }, |
| { |
| .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION, |
| .idVendor = 0x06e1, /* Vendor ID of ADS Technologies */ |
| .idProduct = 0x0709, /* Product ID of DVD Xpress DX2 */ |
| .bcdDevice_lo = 0x204, |
| .bcdDevice_hi = 0x204, |
| .driver_info = (kernel_ulong_t)GO7007_BOARDID_ADS_USBAV_709, |
| }, |
| { } /* Terminating entry */ |
| }; |
| |
| MODULE_DEVICE_TABLE(usb, go7007_usb_id_table); |
| |
| /********************* Driver for EZ-USB HPI interface *********************/ |
| |
| static int go7007_usb_vendor_request(struct go7007 *go, int request, |
| int value, int index, void *transfer_buffer, int length, int in) |
| { |
| struct go7007_usb *usb = go->hpi_context; |
| int timeout = 5000; |
| |
| if (in) { |
| return usb_control_msg(usb->usbdev, |
| usb_rcvctrlpipe(usb->usbdev, 0), request, |
| USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, |
| value, index, transfer_buffer, length, timeout); |
| } else { |
| return usb_control_msg(usb->usbdev, |
| usb_sndctrlpipe(usb->usbdev, 0), request, |
| USB_TYPE_VENDOR | USB_RECIP_DEVICE, |
| value, index, transfer_buffer, length, timeout); |
| } |
| } |
| |
| static int go7007_usb_interface_reset(struct go7007 *go) |
| { |
| struct go7007_usb *usb = go->hpi_context; |
| u16 intr_val, intr_data; |
| |
| if (go->status == STATUS_SHUTDOWN) |
| return -1; |
| /* Reset encoder */ |
| if (go7007_write_interrupt(go, 0x0001, 0x0001) < 0) |
| return -1; |
| msleep(100); |
| |
| if (usb->board->flags & GO7007_USB_EZUSB) { |
| /* Reset buffer in EZ-USB */ |
| pr_debug("resetting EZ-USB buffers\n"); |
| if (go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0 || |
| go7007_usb_vendor_request(go, 0x10, 0, 0, NULL, 0, 0) < 0) |
| return -1; |
| |
| /* Reset encoder again */ |
| if (go7007_write_interrupt(go, 0x0001, 0x0001) < 0) |
| return -1; |
| msleep(100); |
| } |
| |
| /* Wait for an interrupt to indicate successful hardware reset */ |
| if (go7007_read_interrupt(go, &intr_val, &intr_data) < 0 || |
| (intr_val & ~0x1) != 0x55aa) { |
| dev_err(go->dev, "unable to reset the USB interface\n"); |
| return -1; |
| } |
| return 0; |
| } |
| |
| static int go7007_usb_ezusb_write_interrupt(struct go7007 *go, |
| int addr, int data) |
| { |
| struct go7007_usb *usb = go->hpi_context; |
| int i, r; |
| u16 status_reg = 0; |
| int timeout = 500; |
| |
| pr_debug("WriteInterrupt: %04x %04x\n", addr, data); |
| |
| for (i = 0; i < 100; ++i) { |
| r = usb_control_msg(usb->usbdev, |
| usb_rcvctrlpipe(usb->usbdev, 0), 0x14, |
| USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, |
| 0, HPI_STATUS_ADDR, go->usb_buf, |
| sizeof(status_reg), timeout); |
| if (r < 0) |
| break; |
| status_reg = le16_to_cpu(*((__le16 *)go->usb_buf)); |
| if (!(status_reg & 0x0010)) |
| break; |
| msleep(10); |
| } |
| if (r < 0) |
| goto write_int_error; |
| if (i == 100) { |
| dev_err(go->dev, "device is hung, status reg = 0x%04x\n", status_reg); |
| return -1; |
| } |
| r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 0), 0x12, |
| USB_TYPE_VENDOR | USB_RECIP_DEVICE, data, |
| INT_PARAM_ADDR, NULL, 0, timeout); |
| if (r < 0) |
| goto write_int_error; |
| r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 0), |
| 0x12, USB_TYPE_VENDOR | USB_RECIP_DEVICE, addr, |
| INT_INDEX_ADDR, NULL, 0, timeout); |
| if (r < 0) |
| goto write_int_error; |
| return 0; |
| |
| write_int_error: |
| dev_err(go->dev, "error in WriteInterrupt: %d\n", r); |
| return r; |
| } |
| |
| static int go7007_usb_onboard_write_interrupt(struct go7007 *go, |
| int addr, int data) |
| { |
| struct go7007_usb *usb = go->hpi_context; |
| int r; |
| int timeout = 500; |
| |
| pr_debug("WriteInterrupt: %04x %04x\n", addr, data); |
| |
| go->usb_buf[0] = data & 0xff; |
| go->usb_buf[1] = data >> 8; |
| go->usb_buf[2] = addr & 0xff; |
| go->usb_buf[3] = addr >> 8; |
| go->usb_buf[4] = go->usb_buf[5] = go->usb_buf[6] = go->usb_buf[7] = 0; |
| r = usb_control_msg(usb->usbdev, usb_sndctrlpipe(usb->usbdev, 2), 0x00, |
| USB_TYPE_VENDOR | USB_RECIP_ENDPOINT, 0x55aa, |
| 0xf0f0, go->usb_buf, 8, timeout); |
| if (r < 0) { |
| dev_err(go->dev, "error in WriteInterrupt: %d\n", r); |
| return r; |
| } |
| return 0; |
| } |
| |
| static void go7007_usb_readinterrupt_complete(struct urb *urb) |
| { |
| struct go7007 *go = (struct go7007 *)urb->context; |
| __le16 *regs = (__le16 *)urb->transfer_buffer; |
| int status = urb->status; |
| |
| if (status) { |
| if (status != -ESHUTDOWN && |
| go->status != STATUS_SHUTDOWN) { |
| dev_err(go->dev, "error in read interrupt: %d\n", urb->status); |
| } else { |
| wake_up(&go->interrupt_waitq); |
| return; |
| } |
| } else if (urb->actual_length != urb->transfer_buffer_length) { |
| dev_err(go->dev, "short read in interrupt pipe!\n"); |
| } else { |
| go->interrupt_available = 1; |
| go->interrupt_data = __le16_to_cpu(regs[0]); |
| go->interrupt_value = __le16_to_cpu(regs[1]); |
| pr_debug("ReadInterrupt: %04x %04x\n", |
| go->interrupt_value, go->interrupt_data); |
| } |
| |
| wake_up(&go->interrupt_waitq); |
| } |
| |
| static int go7007_usb_read_interrupt(struct go7007 *go) |
| { |
| struct go7007_usb *usb = go->hpi_context; |
| int r; |
| |
| r = usb_submit_urb(usb->intr_urb, GFP_KERNEL); |
| if (r < 0) { |
| dev_err(go->dev, "unable to submit interrupt urb: %d\n", r); |
| return r; |
| } |
| return 0; |
| } |
| |
| static void go7007_usb_read_video_pipe_complete(struct urb *urb) |
| { |
| struct go7007 *go = (struct go7007 *)urb->context; |
| int r, status = urb->status; |
| |
| if (!vb2_is_streaming(&go->vidq)) { |
| wake_up_interruptible(&go->frame_waitq); |
| return; |
| } |
| if (status) { |
| dev_err(go->dev, "error in video pipe: %d\n", status); |
| return; |
| } |
| if (urb->actual_length != urb->transfer_buffer_length) { |
| dev_err(go->dev, "short read in video pipe!\n"); |
| return; |
| } |
| go7007_parse_video_stream(go, urb->transfer_buffer, urb->actual_length); |
| r = usb_submit_urb(urb, GFP_ATOMIC); |
| if (r < 0) |
| dev_err(go->dev, "error in video pipe: %d\n", r); |
| } |
| |
| static void go7007_usb_read_audio_pipe_complete(struct urb *urb) |
| { |
| struct go7007 *go = (struct go7007 *)urb->context; |
| int r, status = urb->status; |
| |
| if (!vb2_is_streaming(&go->vidq)) |
| return; |
| if (status) { |
| dev_err(go->dev, "error in audio pipe: %d\n", |
| status); |
| return; |
| } |
| if (urb->actual_length != urb->transfer_buffer_length) { |
| dev_err(go->dev, "short read in audio pipe!\n"); |
| return; |
| } |
| if (go->audio_deliver != NULL) |
| go->audio_deliver(go, urb->transfer_buffer, urb->actual_length); |
| r = usb_submit_urb(urb, GFP_ATOMIC); |
| if (r < 0) |
| dev_err(go->dev, "error in audio pipe: %d\n", r); |
| } |
| |
| static int go7007_usb_stream_start(struct go7007 *go) |
| { |
| struct go7007_usb *usb = go->hpi_context; |
| int i, r; |
| |
| for (i = 0; i < 8; ++i) { |
| r = usb_submit_urb(usb->video_urbs[i], GFP_KERNEL); |
| if (r < 0) { |
| dev_err(go->dev, "error submitting video urb %d: %d\n", i, r); |
| goto video_submit_failed; |
| } |
| } |
| if (!go->audio_enabled) |
| return 0; |
| |
| for (i = 0; i < 8; ++i) { |
| r = usb_submit_urb(usb->audio_urbs[i], GFP_KERNEL); |
| if (r < 0) { |
| dev_err(go->dev, "error submitting audio urb %d: %d\n", i, r); |
| goto audio_submit_failed; |
| } |
| } |
| return 0; |
| |
| audio_submit_failed: |
| for (i = 0; i < 7; ++i) |
| usb_kill_urb(usb->audio_urbs[i]); |
| video_submit_failed: |
| for (i = 0; i < 8; ++i) |
| usb_kill_urb(usb->video_urbs[i]); |
| return -1; |
| } |
| |
| static int go7007_usb_stream_stop(struct go7007 *go) |
| { |
| struct go7007_usb *usb = go->hpi_context; |
| int i; |
| |
| if (go->status == STATUS_SHUTDOWN) |
| return 0; |
| for (i = 0; i < 8; ++i) |
| usb_kill_urb(usb->video_urbs[i]); |
| if (go->audio_enabled) |
| for (i = 0; i < 8; ++i) |
| usb_kill_urb(usb->audio_urbs[i]); |
| return 0; |
| } |
| |
| static int go7007_usb_send_firmware(struct go7007 *go, u8 *data, int len) |
| { |
| struct go7007_usb *usb = go->hpi_context; |
| int transferred, pipe; |
| int timeout = 500; |
| |
| pr_debug("DownloadBuffer sending %d bytes\n", len); |
| |
| if (usb->board->flags & GO7007_USB_EZUSB) |
| pipe = usb_sndbulkpipe(usb->usbdev, 2); |
| else |
| pipe = usb_sndbulkpipe(usb->usbdev, 3); |
| |
| return usb_bulk_msg(usb->usbdev, pipe, data, len, |
| &transferred, timeout); |
| } |
| |
| static void go7007_usb_release(struct go7007 *go) |
| { |
| struct go7007_usb *usb = go->hpi_context; |
| struct urb *vurb, *aurb; |
| int i; |
| |
| if (usb->intr_urb) { |
| usb_kill_urb(usb->intr_urb); |
| kfree(usb->intr_urb->transfer_buffer); |
| usb_free_urb(usb->intr_urb); |
| } |
| |
| /* Free USB-related structs */ |
| for (i = 0; i < 8; ++i) { |
| vurb = usb->video_urbs[i]; |
| if (vurb) { |
| usb_kill_urb(vurb); |
| kfree(vurb->transfer_buffer); |
| usb_free_urb(vurb); |
| } |
| aurb = usb->audio_urbs[i]; |
| if (aurb) { |
| usb_kill_urb(aurb); |
| kfree(aurb->transfer_buffer); |
| usb_free_urb(aurb); |
| } |
| } |
| |
| kfree(go->hpi_context); |
| } |
| |
| static const struct go7007_hpi_ops go7007_usb_ezusb_hpi_ops = { |
| .interface_reset = go7007_usb_interface_reset, |
| .write_interrupt = go7007_usb_ezusb_write_interrupt, |
| .read_interrupt = go7007_usb_read_interrupt, |
| .stream_start = go7007_usb_stream_start, |
| .stream_stop = go7007_usb_stream_stop, |
| .send_firmware = go7007_usb_send_firmware, |
| .release = go7007_usb_release, |
| }; |
| |
| static const struct go7007_hpi_ops go7007_usb_onboard_hpi_ops = { |
| .interface_reset = go7007_usb_interface_reset, |
| .write_interrupt = go7007_usb_onboard_write_interrupt, |
| .read_interrupt = go7007_usb_read_interrupt, |
| .stream_start = go7007_usb_stream_start, |
| .stream_stop = go7007_usb_stream_stop, |
| .send_firmware = go7007_usb_send_firmware, |
| .release = go7007_usb_release, |
| }; |
| |
| /********************* Driver for EZ-USB I2C adapter *********************/ |
| |
| static int go7007_usb_i2c_master_xfer(struct i2c_adapter *adapter, |
| struct i2c_msg msgs[], int num) |
| { |
| struct go7007 *go = i2c_get_adapdata(adapter); |
| struct go7007_usb *usb = go->hpi_context; |
| u8 *buf = go->usb_buf; |
| int buf_len, i; |
| int ret = -EIO; |
| |
| if (go->status == STATUS_SHUTDOWN) |
| return -ENODEV; |
| |
| mutex_lock(&usb->i2c_lock); |
| |
| for (i = 0; i < num; ++i) { |
| /* The hardware command is "write some bytes then read some |
| * bytes", so we try to coalesce a write followed by a read |
| * into a single USB transaction */ |
| if (i + 1 < num && msgs[i].addr == msgs[i + 1].addr && |
| !(msgs[i].flags & I2C_M_RD) && |
| (msgs[i + 1].flags & I2C_M_RD)) { |
| #ifdef GO7007_I2C_DEBUG |
| pr_debug("i2c write/read %d/%d bytes on %02x\n", |
| msgs[i].len, msgs[i + 1].len, msgs[i].addr); |
| #endif |
| buf[0] = 0x01; |
| buf[1] = msgs[i].len + 1; |
| buf[2] = msgs[i].addr << 1; |
| memcpy(&buf[3], msgs[i].buf, msgs[i].len); |
| buf_len = msgs[i].len + 3; |
| buf[buf_len++] = msgs[++i].len; |
| } else if (msgs[i].flags & I2C_M_RD) { |
| #ifdef GO7007_I2C_DEBUG |
| pr_debug("i2c read %d bytes on %02x\n", |
| msgs[i].len, msgs[i].addr); |
| #endif |
| buf[0] = 0x01; |
| buf[1] = 1; |
| buf[2] = msgs[i].addr << 1; |
| buf[3] = msgs[i].len; |
| buf_len = 4; |
| } else { |
| #ifdef GO7007_I2C_DEBUG |
| pr_debug("i2c write %d bytes on %02x\n", |
| msgs[i].len, msgs[i].addr); |
| #endif |
| buf[0] = 0x00; |
| buf[1] = msgs[i].len + 1; |
| buf[2] = msgs[i].addr << 1; |
| memcpy(&buf[3], msgs[i].buf, msgs[i].len); |
| buf_len = msgs[i].len + 3; |
| buf[buf_len++] = 0; |
| } |
| if (go7007_usb_vendor_request(go, 0x24, 0, 0, |
| buf, buf_len, 0) < 0) |
| goto i2c_done; |
| if (msgs[i].flags & I2C_M_RD) { |
| memset(buf, 0, msgs[i].len + 1); |
| if (go7007_usb_vendor_request(go, 0x25, 0, 0, buf, |
| msgs[i].len + 1, 1) < 0) |
| goto i2c_done; |
| memcpy(msgs[i].buf, buf + 1, msgs[i].len); |
| } |
| } |
| ret = num; |
| |
| i2c_done: |
| mutex_unlock(&usb->i2c_lock); |
| return ret; |
| } |
| |
| static u32 go7007_usb_functionality(struct i2c_adapter *adapter) |
| { |
| /* No errors are reported by the hardware, so we don't bother |
| * supporting quick writes to avoid confusing probing */ |
| return (I2C_FUNC_SMBUS_EMUL) & ~I2C_FUNC_SMBUS_QUICK; |
| } |
| |
| static const struct i2c_algorithm go7007_usb_algo = { |
| .master_xfer = go7007_usb_i2c_master_xfer, |
| .functionality = go7007_usb_functionality, |
| }; |
| |
| static struct i2c_adapter go7007_usb_adap_templ = { |
| .owner = THIS_MODULE, |
| .name = "WIS GO7007SB EZ-USB", |
| .algo = &go7007_usb_algo, |
| }; |
| |
| /********************* USB add/remove functions *********************/ |
| |
| static int go7007_usb_probe(struct usb_interface *intf, |
| const struct usb_device_id *id) |
| { |
| struct go7007 *go; |
| struct go7007_usb *usb; |
| const struct go7007_usb_board *board; |
| struct usb_device *usbdev = interface_to_usbdev(intf); |
| struct usb_host_endpoint *ep; |
| unsigned num_i2c_devs; |
| char *name; |
| int video_pipe, i, v_urb_len; |
| |
| pr_debug("probing new GO7007 USB board\n"); |
| |
| switch (id->driver_info) { |
| case GO7007_BOARDID_MATRIX_II: |
| name = "WIS Matrix II or compatible"; |
| board = &board_matrix_ii; |
| break; |
| case GO7007_BOARDID_MATRIX_RELOAD: |
| name = "WIS Matrix Reloaded or compatible"; |
| board = &board_matrix_reload; |
| break; |
| case GO7007_BOARDID_MATRIX_REV: |
| name = "WIS Matrix Revolution or compatible"; |
| board = &board_matrix_revolution; |
| break; |
| case GO7007_BOARDID_STAR_TREK: |
| name = "WIS Star Trek or compatible"; |
| board = &board_star_trek; |
| break; |
| case GO7007_BOARDID_XMEN: |
| name = "WIS XMen or compatible"; |
| board = &board_xmen; |
| break; |
| case GO7007_BOARDID_XMEN_II: |
| name = "WIS XMen II or compatible"; |
| board = &board_xmen; |
| break; |
| case GO7007_BOARDID_XMEN_III: |
| name = "WIS XMen III or compatible"; |
| board = &board_xmen; |
| break; |
| case GO7007_BOARDID_PX_M402U: |
| name = "Plextor PX-M402U"; |
| board = &board_matrix_ii; |
| break; |
| case GO7007_BOARDID_PX_TV402U: |
| name = "Plextor PX-TV402U (unknown tuner)"; |
| board = &board_px_tv402u; |
| break; |
| case GO7007_BOARDID_LIFEVIEW_LR192: |
| dev_err(&intf->dev, "The Lifeview TV Walker Ultra is not supported. Sorry!\n"); |
| return -ENODEV; |
| #if 0 |
| name = "Lifeview TV Walker Ultra"; |
| board = &board_lifeview_lr192; |
| #endif |
| break; |
| case GO7007_BOARDID_SENSORAY_2250: |
| dev_info(&intf->dev, "Sensoray 2250 found\n"); |
| name = "Sensoray 2250/2251"; |
| board = &board_sensoray_2250; |
| break; |
| case GO7007_BOARDID_ADS_USBAV_709: |
| name = "ADS Tech DVD Xpress DX2"; |
| board = &board_ads_usbav_709; |
| break; |
| default: |
| dev_err(&intf->dev, "unknown board ID %d!\n", |
| (unsigned int)id->driver_info); |
| return -ENODEV; |
| } |
| |
| go = go7007_alloc(&board->main_info, &intf->dev); |
| if (go == NULL) |
| return -ENOMEM; |
| |
| usb = kzalloc(sizeof(struct go7007_usb), GFP_KERNEL); |
| if (usb == NULL) { |
| kfree(go); |
| return -ENOMEM; |
| } |
| |
| usb->board = board; |
| usb->usbdev = usbdev; |
| usb_make_path(usbdev, go->bus_info, sizeof(go->bus_info)); |
| go->board_id = id->driver_info; |
| strscpy(go->name, name, sizeof(go->name)); |
| if (board->flags & GO7007_USB_EZUSB) |
| go->hpi_ops = &go7007_usb_ezusb_hpi_ops; |
| else |
| go->hpi_ops = &go7007_usb_onboard_hpi_ops; |
| go->hpi_context = usb; |
| |
| ep = usb->usbdev->ep_in[4]; |
| if (!ep) |
| goto allocfail; |
| |
| /* Allocate the URB and buffer for receiving incoming interrupts */ |
| usb->intr_urb = usb_alloc_urb(0, GFP_KERNEL); |
| if (usb->intr_urb == NULL) |
| goto allocfail; |
| usb->intr_urb->transfer_buffer = kmalloc_array(2, sizeof(u16), |
| GFP_KERNEL); |
| if (usb->intr_urb->transfer_buffer == NULL) |
| goto allocfail; |
| |
| if (usb_endpoint_type(&ep->desc) == USB_ENDPOINT_XFER_BULK) |
| usb_fill_bulk_urb(usb->intr_urb, usb->usbdev, |
| usb_rcvbulkpipe(usb->usbdev, 4), |
| usb->intr_urb->transfer_buffer, 2*sizeof(u16), |
| go7007_usb_readinterrupt_complete, go); |
| else |
| usb_fill_int_urb(usb->intr_urb, usb->usbdev, |
| usb_rcvintpipe(usb->usbdev, 4), |
| usb->intr_urb->transfer_buffer, 2*sizeof(u16), |
| go7007_usb_readinterrupt_complete, go, 8); |
| usb_set_intfdata(intf, &go->v4l2_dev); |
| |
| /* Boot the GO7007 */ |
| if (go7007_boot_encoder(go, go->board_info->flags & |
| GO7007_BOARD_USE_ONBOARD_I2C) < 0) |
| goto allocfail; |
| |
| /* Register the EZ-USB I2C adapter, if we're using it */ |
| if (board->flags & GO7007_USB_EZUSB_I2C) { |
| memcpy(&go->i2c_adapter, &go7007_usb_adap_templ, |
| sizeof(go7007_usb_adap_templ)); |
| mutex_init(&usb->i2c_lock); |
| go->i2c_adapter.dev.parent = go->dev; |
| i2c_set_adapdata(&go->i2c_adapter, go); |
| if (i2c_add_adapter(&go->i2c_adapter) < 0) { |
| dev_err(go->dev, "error: i2c_add_adapter failed\n"); |
| goto allocfail; |
| } |
| go->i2c_adapter_online = 1; |
| } |
| |
| /* Pelco and Adlink reused the XMen and XMen-III vendor and product |
| * IDs for their own incompatible designs. We can detect XMen boards |
| * by probing the sensor, but there is no way to probe the sensors on |
| * the Pelco and Adlink designs so we default to the Adlink. If it |
| * is actually a Pelco, the user must set the assume_endura module |
| * parameter. */ |
| if ((go->board_id == GO7007_BOARDID_XMEN || |
| go->board_id == GO7007_BOARDID_XMEN_III) && |
| go->i2c_adapter_online) { |
| union i2c_smbus_data data; |
| |
| /* Check to see if register 0x0A is 0x76 */ |
| i2c_smbus_xfer(&go->i2c_adapter, 0x21, I2C_CLIENT_SCCB, |
| I2C_SMBUS_READ, 0x0A, I2C_SMBUS_BYTE_DATA, &data); |
| if (data.byte != 0x76) { |
| if (assume_endura) { |
| go->board_id = GO7007_BOARDID_ENDURA; |
| usb->board = board = &board_endura; |
| go->board_info = &board->main_info; |
| strscpy(go->name, "Pelco Endura", |
| sizeof(go->name)); |
| } else { |
| u16 channel; |
| |
| /* read channel number from GPIO[1:0] */ |
| if (go7007_read_addr(go, 0x3c81, &channel)) |
| goto allocfail; |
| |
| channel &= 0x3; |
| go->board_id = GO7007_BOARDID_ADLINK_MPG24; |
| usb->board = board = &board_adlink_mpg24; |
| go->board_info = &board->main_info; |
| go->channel_number = channel; |
| snprintf(go->name, sizeof(go->name), |
| "Adlink PCI-MPG24, channel #%d", |
| channel); |
| } |
| go7007_update_board(go); |
| } |
| } |
| |
| num_i2c_devs = go->board_info->num_i2c_devs; |
| |
| /* Probe the tuner model on the TV402U */ |
| if (go->board_id == GO7007_BOARDID_PX_TV402U) { |
| /* Board strapping indicates tuner model */ |
| if (go7007_usb_vendor_request(go, 0x41, 0, 0, go->usb_buf, 3, |
| 1) < 0) { |
| dev_err(go->dev, "GPIO read failed!\n"); |
| goto allocfail; |
| } |
| switch (go->usb_buf[0] >> 6) { |
| case 1: |
| go->tuner_type = TUNER_SONY_BTF_PG472Z; |
| go->std = V4L2_STD_PAL; |
| strscpy(go->name, "Plextor PX-TV402U-EU", |
| sizeof(go->name)); |
| break; |
| case 2: |
| go->tuner_type = TUNER_SONY_BTF_PK467Z; |
| go->std = V4L2_STD_NTSC_M_JP; |
| num_i2c_devs -= 2; |
| strscpy(go->name, "Plextor PX-TV402U-JP", |
| sizeof(go->name)); |
| break; |
| case 3: |
| go->tuner_type = TUNER_SONY_BTF_PB463Z; |
| num_i2c_devs -= 2; |
| strscpy(go->name, "Plextor PX-TV402U-NA", |
| sizeof(go->name)); |
| break; |
| default: |
| pr_debug("unable to detect tuner type!\n"); |
| break; |
| } |
| /* Configure tuner mode selection inputs connected |
| * to the EZ-USB GPIO output pins */ |
| if (go7007_usb_vendor_request(go, 0x40, 0x7f02, 0, |
| NULL, 0, 0) < 0) { |
| dev_err(go->dev, "GPIO write failed!\n"); |
| goto allocfail; |
| } |
| } |
| |
| /* Print a nasty message if the user attempts to use a USB2.0 device in |
| * a USB1.1 port. There will be silent corruption of the stream. */ |
| if ((board->flags & GO7007_USB_EZUSB) && |
| usbdev->speed != USB_SPEED_HIGH) |
| 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"); |
| |
| /* Allocate the URBs and buffers for receiving the video stream */ |
| if (board->flags & GO7007_USB_EZUSB) { |
| if (!usb->usbdev->ep_in[6]) |
| goto allocfail; |
| v_urb_len = 1024; |
| video_pipe = usb_rcvbulkpipe(usb->usbdev, 6); |
| } else { |
| if (!usb->usbdev->ep_in[1]) |
| goto allocfail; |
| v_urb_len = 512; |
| video_pipe = usb_rcvbulkpipe(usb->usbdev, 1); |
| } |
| for (i = 0; i < 8; ++i) { |
| usb->video_urbs[i] = usb_alloc_urb(0, GFP_KERNEL); |
| if (usb->video_urbs[i] == NULL) |
| goto allocfail; |
| usb->video_urbs[i]->transfer_buffer = |
| kmalloc(v_urb_len, GFP_KERNEL); |
| if (usb->video_urbs[i]->transfer_buffer == NULL) |
| goto allocfail; |
| usb_fill_bulk_urb(usb->video_urbs[i], usb->usbdev, video_pipe, |
| usb->video_urbs[i]->transfer_buffer, v_urb_len, |
| go7007_usb_read_video_pipe_complete, go); |
| } |
| |
| /* Allocate the URBs and buffers for receiving the audio stream */ |
| if ((board->flags & GO7007_USB_EZUSB) && |
| (board->main_info.flags & GO7007_BOARD_HAS_AUDIO)) { |
| if (!usb->usbdev->ep_in[8]) |
| goto allocfail; |
| for (i = 0; i < 8; ++i) { |
| usb->audio_urbs[i] = usb_alloc_urb(0, GFP_KERNEL); |
| if (usb->audio_urbs[i] == NULL) |
| goto allocfail; |
| usb->audio_urbs[i]->transfer_buffer = kmalloc(4096, |
| GFP_KERNEL); |
| if (usb->audio_urbs[i]->transfer_buffer == NULL) |
| goto allocfail; |
| usb_fill_bulk_urb(usb->audio_urbs[i], usb->usbdev, |
| usb_rcvbulkpipe(usb->usbdev, 8), |
| usb->audio_urbs[i]->transfer_buffer, 4096, |
| go7007_usb_read_audio_pipe_complete, go); |
| } |
| } |
| |
| /* Do any final GO7007 initialization, then register the |
| * V4L2 and ALSA interfaces */ |
| if (go7007_register_encoder(go, num_i2c_devs) < 0) |
| goto allocfail; |
| |
| go->status = STATUS_ONLINE; |
| return 0; |
| |
| allocfail: |
| go7007_usb_release(go); |
| kfree(go); |
| return -ENOMEM; |
| } |
| |
| static void go7007_usb_disconnect(struct usb_interface *intf) |
| { |
| struct go7007 *go = to_go7007(usb_get_intfdata(intf)); |
| |
| mutex_lock(&go->queue_lock); |
| mutex_lock(&go->serialize_lock); |
| |
| if (go->audio_enabled) |
| go7007_snd_remove(go); |
| |
| go->status = STATUS_SHUTDOWN; |
| v4l2_device_disconnect(&go->v4l2_dev); |
| video_unregister_device(&go->vdev); |
| mutex_unlock(&go->serialize_lock); |
| mutex_unlock(&go->queue_lock); |
| |
| v4l2_device_put(&go->v4l2_dev); |
| } |
| |
| static struct usb_driver go7007_usb_driver = { |
| .name = "go7007", |
| .probe = go7007_usb_probe, |
| .disconnect = go7007_usb_disconnect, |
| .id_table = go7007_usb_id_table, |
| }; |
| |
| module_usb_driver(go7007_usb_driver); |
| MODULE_DESCRIPTION("WIS GO7007 USB support"); |
| MODULE_LICENSE("GPL v2"); |