2 cx231xx-core.c - driver for Conexant Cx23100/101/102 USB video capture devices
4 Copyright (C) 2008 <srinivasa.deevi at conexant dot com>
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License as published by
9 the Free Software Foundation; either version 2 of the License, or
10 (at your option) any later version.
12 This program is distributed in the hope that it will be useful,
13 but WITHOUT ANY WARRANTY; without even the implied warranty of
14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 GNU General Public License for more details.
17 You should have received a copy of the GNU General Public License
18 along with this program; if not, write to the Free Software
19 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 #include <linux/init.h>
23 #include <linux/list.h>
24 #include <linux/module.h>
25 #include <linux/usb.h>
26 #include <linux/vmalloc.h>
27 #include <media/v4l2-common.h>
30 #include "cx231xx-reg.h"
32 /* #define ENABLE_DEBUG_ISOC_FRAMES */
34 static unsigned int core_debug;
35 module_param(core_debug, int, 0644);
36 MODULE_PARM_DESC(core_debug, "enable debug messages [core]");
38 #define cx231xx_coredbg(fmt, arg...) do {\
40 printk(KERN_INFO "%s %s :"fmt, \
41 dev->name, __func__ , ##arg); } while (0)
43 static unsigned int reg_debug;
44 module_param(reg_debug, int, 0644);
45 MODULE_PARM_DESC(reg_debug, "enable debug messages [URB reg]");
47 #define cx231xx_regdbg(fmt, arg...) do {\
49 printk(KERN_INFO "%s %s :"fmt, \
50 dev->name, __func__ , ##arg); } while (0)
52 static int alt = CX231XX_PINOUT;
53 module_param(alt, int, 0644);
54 MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint");
57 #define cx231xx_isocdbg(fmt, arg...) do {\
59 printk(KERN_INFO "%s %s :"fmt, \
60 dev->name, __func__ , ##arg); } while (0)
62 /************************************************************************************
63 * Device control list functions *
64 *************************************************************************************/
66 static LIST_HEAD(cx231xx_devlist);
67 static DEFINE_MUTEX(cx231xx_devlist_mutex);
69 struct cx231xx *cx231xx_get_device(int minor,
70 enum v4l2_buf_type *fh_type, int *has_radio)
72 struct cx231xx *h, *dev = NULL;
74 *fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
77 mutex_lock(&cx231xx_devlist_mutex);
78 list_for_each_entry(h, &cx231xx_devlist, devlist) {
79 if (h->vdev->minor == minor)
81 if (h->vbi_dev->minor == minor) {
83 *fh_type = V4L2_BUF_TYPE_VBI_CAPTURE;
85 if (h->radio_dev && h->radio_dev->minor == minor) {
90 mutex_unlock(&cx231xx_devlist_mutex);
96 * cx231xx_realease_resources()
97 * unregisters the v4l2,i2c and usb devices
98 * called when the device gets disconected or at module unload
100 void cx231xx_remove_from_devlist(struct cx231xx *dev)
102 mutex_lock(&cx231xx_devlist_mutex);
103 list_del(&dev->devlist);
104 mutex_unlock(&cx231xx_devlist_mutex);
107 void cx231xx_add_into_devlist(struct cx231xx *dev)
109 mutex_lock(&cx231xx_devlist_mutex);
110 list_add_tail(&dev->devlist, &cx231xx_devlist);
111 mutex_unlock(&cx231xx_devlist_mutex);
114 static LIST_HEAD(cx231xx_extension_devlist);
115 static DEFINE_MUTEX(cx231xx_extension_devlist_lock);
117 int cx231xx_register_extension(struct cx231xx_ops *ops)
119 struct cx231xx *dev = NULL;
121 mutex_lock(&cx231xx_devlist_mutex);
122 mutex_lock(&cx231xx_extension_devlist_lock);
123 list_add_tail(&ops->next, &cx231xx_extension_devlist);
124 list_for_each_entry(dev, &cx231xx_devlist, devlist) {
128 cx231xx_info("Cx231xx: Initialized (%s) extension\n", ops->name);
129 mutex_unlock(&cx231xx_extension_devlist_lock);
130 mutex_unlock(&cx231xx_devlist_mutex);
134 EXPORT_SYMBOL(cx231xx_register_extension);
136 void cx231xx_unregister_extension(struct cx231xx_ops *ops)
138 struct cx231xx *dev = NULL;
140 mutex_lock(&cx231xx_devlist_mutex);
141 list_for_each_entry(dev, &cx231xx_devlist, devlist) {
146 mutex_lock(&cx231xx_extension_devlist_lock);
147 cx231xx_info("Cx231xx: Removed (%s) extension\n", ops->name);
148 list_del(&ops->next);
149 mutex_unlock(&cx231xx_extension_devlist_lock);
150 mutex_unlock(&cx231xx_devlist_mutex);
153 EXPORT_SYMBOL(cx231xx_unregister_extension);
155 void cx231xx_init_extension(struct cx231xx *dev)
157 struct cx231xx_ops *ops = NULL;
159 mutex_lock(&cx231xx_extension_devlist_lock);
160 if (!list_empty(&cx231xx_extension_devlist)) {
161 list_for_each_entry(ops, &cx231xx_extension_devlist, next) {
166 mutex_unlock(&cx231xx_extension_devlist_lock);
169 void cx231xx_close_extension(struct cx231xx *dev)
171 struct cx231xx_ops *ops = NULL;
173 mutex_lock(&cx231xx_extension_devlist_lock);
174 if (!list_empty(&cx231xx_extension_devlist)) {
175 list_for_each_entry(ops, &cx231xx_extension_devlist, next) {
180 mutex_unlock(&cx231xx_extension_devlist_lock);
183 /************************************************************************************
184 * U S B related functions *
185 *************************************************************************************/
186 int cx231xx_send_usb_command(struct cx231xx_i2c *i2c_bus,
187 struct cx231xx_i2c_xfer_data *req_data)
190 struct cx231xx *dev = i2c_bus->dev;
191 VENDOR_REQUEST_IN ven_req;
198 /* Get the I2C period, nostop and reserve parameters */
199 _i2c_period = i2c_bus->i2c_period;
200 _i2c_nostop = i2c_bus->i2c_nostop;
201 _i2c_reserve = i2c_bus->i2c_reserve;
203 saddr_len = req_data->saddr_len;
206 if (saddr_len == 1) /* need check saddr_len == 0 */
209 dev_addr << 9 | _i2c_period << 4 | saddr_len << 2 |
210 _i2c_nostop << 1 | I2C_SYNC | _i2c_reserve << 6;
214 dev_addr << 9 | _i2c_period << 4 | saddr_len << 2 |
215 _i2c_nostop << 1 | I2C_SYNC | _i2c_reserve << 6;
217 /* set channel number */
218 if (req_data->direction & I2C_M_RD)
219 ven_req.bRequest = i2c_bus->nr + 4; /* channel number, for read,
220 spec required channel_num +4 */
222 ven_req.bRequest = i2c_bus->nr; /* channel number, */
224 /* set index value */
227 ven_req.wIndex = 0; /* need check */
230 ven_req.wIndex = (req_data->saddr_dat & 0xff);
233 ven_req.wIndex = req_data->saddr_dat;
237 /* set wLength value */
238 ven_req.wLength = req_data->buf_size;
240 /* set bData value */
243 /* set the direction */
244 if (req_data->direction) {
245 ven_req.direction = USB_DIR_IN;
246 memset(req_data->p_buffer, 0x00, ven_req.wLength);
248 ven_req.direction = USB_DIR_OUT;
250 /* set the buffer for read / write */
251 ven_req.pBuff = req_data->p_buffer;
254 /* call common vendor command request */
255 status = cx231xx_send_vendor_cmd(dev, &ven_req);
258 ("UsbInterface::sendCommand, output buffer failed with status -%d\n",
265 EXPORT_SYMBOL_GPL(cx231xx_send_usb_command);
267 * cx231xx_read_ctrl_reg()
268 * reads data from the usb device specifying bRequest and wValue
270 int cx231xx_read_ctrl_reg(struct cx231xx *dev, u8 req, u16 reg,
275 int pipe = usb_rcvctrlpipe(dev->udev, 0);
277 if (dev->state & DEV_DISCONNECTED)
280 if (len > URB_MAX_CTRL_SIZE)
285 val = ENABLE_ONE_BYTE;
288 val = ENABLE_TWE_BYTE;
291 val = ENABLE_THREE_BYTE;
294 val = ENABLE_FOUR_BYTE;
297 val = 0xFF; /* invalid option */
304 cx231xx_isocdbg("(pipe 0x%08x): "
305 "IN: %02x %02x %02x %02x %02x %02x %02x %02x ",
307 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
309 reg & 0xff, reg >> 8, len & 0xff, len >> 8);
312 /* mutex_lock(&dev->ctrl_urb_lock); */
313 ret = usb_control_msg(dev->udev, pipe, req,
314 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
315 val, reg, dev->urb_buf, len, HZ);
317 cx231xx_isocdbg(" failed!\n");
318 /* mutex_unlock(&dev->ctrl_urb_lock); */
323 memcpy(buf, dev->urb_buf, len);
325 /* mutex_unlock(&dev->ctrl_urb_lock); */
330 cx231xx_isocdbg("<<<");
331 for (byte = 0; byte < len; byte++)
332 cx231xx_isocdbg(" %02x", (unsigned char)buf[byte]);
333 cx231xx_isocdbg("\n");
339 int cx231xx_send_vendor_cmd(struct cx231xx *dev, VENDOR_REQUEST_IN * ven_req)
344 if (dev->state & DEV_DISCONNECTED)
347 if ((ven_req->wLength > URB_MAX_CTRL_SIZE))
350 if (ven_req->direction)
351 pipe = usb_rcvctrlpipe(dev->udev, 0);
353 pipe = usb_sndctrlpipe(dev->udev, 0);
358 cx231xx_isocdbg("(pipe 0x%08x): "
359 "OUT: %02x %02x %02x %04x %04x %04x >>>",
362 direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
363 ven_req->bRequest, 0, ven_req->wValue,
364 ven_req->wIndex, ven_req->wLength);
366 for (byte = 0; byte < ven_req->wLength; byte++)
367 cx231xx_isocdbg(" %02x",
368 (unsigned char)ven_req->pBuff[byte]);
369 cx231xx_isocdbg("\n");
372 /* mutex_lock(&dev->ctrl_urb_lock); */
373 ret = usb_control_msg(dev->udev, pipe, ven_req->bRequest,
375 direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
376 ven_req->wValue, ven_req->wIndex, ven_req->pBuff,
377 ven_req->wLength, HZ);
378 /* mutex_unlock(&dev->ctrl_urb_lock); */
384 * cx231xx_write_ctrl_reg()
385 * sends data to the usb device, specifying bRequest
387 int cx231xx_write_ctrl_reg(struct cx231xx *dev, u8 req, u16 reg, char *buf,
392 int pipe = usb_sndctrlpipe(dev->udev, 0);
394 if (dev->state & DEV_DISCONNECTED)
397 if ((len < 1) || (len > URB_MAX_CTRL_SIZE))
402 val = ENABLE_ONE_BYTE;
405 val = ENABLE_TWE_BYTE;
408 val = ENABLE_THREE_BYTE;
411 val = ENABLE_FOUR_BYTE;
414 val = 0xFF; /* invalid option */
423 cx231xx_isocdbg("(pipe 0x%08x): "
424 "OUT: %02x %02x %02x %02x %02x %02x %02x %02x >>>",
426 USB_DIR_OUT | USB_TYPE_VENDOR |
427 USB_RECIP_DEVICE, req, 0, val, reg & 0xff,
428 reg >> 8, len & 0xff, len >> 8);
430 for (byte = 0; byte < len; byte++)
431 cx231xx_isocdbg(" %02x", (unsigned char)buf[byte]);
432 cx231xx_isocdbg("\n");
435 /* mutex_lock(&dev->ctrl_urb_lock); */
436 memcpy(dev->urb_buf, buf, len);
437 ret = usb_control_msg(dev->udev, pipe, req,
438 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
439 val, reg, dev->urb_buf, len, HZ);
440 /* mutex_unlock(&dev->ctrl_urb_lock); */
445 /************************************************************************************
446 * USB Alternate Setting functions *
447 *************************************************************************************/
449 int cx231xx_set_video_alternate(struct cx231xx *dev)
451 int errCode, prev_alt = dev->video_mode.alt;
452 unsigned int min_pkt_size = dev->width * 2 + 4;
453 u32 usb_interface_index = 0;
455 /* When image size is bigger than a certain value,
456 the frame size should be increased, otherwise, only
457 green screen will be received.
459 if (dev->width * 2 * dev->height > 720 * 240 * 2)
462 if (dev->width > 360) {
463 /* resolutions: 720,704,640 */
464 dev->video_mode.alt = 3;
465 } else if (dev->width > 180) {
466 /* resolutions: 360,352,320,240 */
467 dev->video_mode.alt = 2;
468 } else if (dev->width > 0) {
469 /* resolutions: 180,176,160,128,88 */
470 dev->video_mode.alt = 1;
472 /* Change to alt0 BULK to release USB bandwidth */
473 dev->video_mode.alt = 0;
476 /* Get the correct video interface Index */
477 usb_interface_index =
478 dev->current_pcb_config.hs_config_info[0].interface_info.
481 if (dev->video_mode.alt != prev_alt) {
482 cx231xx_coredbg("minimum isoc packet size: %u (alt=%d)\n",
483 min_pkt_size, dev->video_mode.alt);
484 dev->video_mode.max_pkt_size =
485 dev->video_mode.alt_max_pkt_size[dev->video_mode.alt];
486 cx231xx_coredbg("setting alternate %d with wMaxPacketSize=%u\n",
488 dev->video_mode.max_pkt_size);
490 (" setting alternate %d with wMaxPacketSize=%u , Interface = %d\n",
491 dev->video_mode.alt, dev->video_mode.max_pkt_size,
492 usb_interface_index);
494 usb_set_interface(dev->udev, usb_interface_index,
495 dev->video_mode.alt);
498 ("cannot change alternate number to %d (error=%i)\n",
499 dev->video_mode.alt, errCode);
506 int cx231xx_set_alt_setting(struct cx231xx *dev, u8 index, u8 alt)
509 u32 usb_interface_index = 0;
510 u32 max_pkt_size = 0;
514 usb_interface_index =
515 dev->current_pcb_config.hs_config_info[0].interface_info.
517 dev->video_mode.alt = alt;
518 if (dev->ts1_mode.alt_max_pkt_size != NULL)
519 max_pkt_size = dev->ts1_mode.max_pkt_size =
520 dev->ts1_mode.alt_max_pkt_size[dev->ts1_mode.alt];
523 usb_interface_index =
524 dev->current_pcb_config.hs_config_info[0].interface_info.
528 usb_interface_index =
529 dev->current_pcb_config.hs_config_info[0].interface_info.
532 if (dev->adev.alt_max_pkt_size != NULL)
533 max_pkt_size = dev->adev.max_pkt_size =
534 dev->adev.alt_max_pkt_size[dev->adev.alt];
537 usb_interface_index =
538 dev->current_pcb_config.hs_config_info[0].interface_info.
540 dev->video_mode.alt = alt;
541 if (dev->video_mode.alt_max_pkt_size != NULL)
542 max_pkt_size = dev->video_mode.max_pkt_size =
543 dev->video_mode.alt_max_pkt_size[dev->video_mode.
547 usb_interface_index =
548 dev->current_pcb_config.hs_config_info[0].interface_info.
550 dev->vbi_mode.alt = alt;
551 if (dev->vbi_mode.alt_max_pkt_size != NULL)
552 max_pkt_size = dev->vbi_mode.max_pkt_size =
553 dev->vbi_mode.alt_max_pkt_size[dev->vbi_mode.alt];
556 usb_interface_index =
557 dev->current_pcb_config.hs_config_info[0].interface_info.
559 dev->sliced_cc_mode.alt = alt;
560 if (dev->sliced_cc_mode.alt_max_pkt_size != NULL)
561 max_pkt_size = dev->sliced_cc_mode.max_pkt_size =
562 dev->sliced_cc_mode.alt_max_pkt_size[dev->
570 if (alt > 0 && max_pkt_size == 0) {
572 ("cannot change interface %d alternate number to %d : Max. Pkt size is ZERO\n",
573 usb_interface_index, alt);
578 (" setting alternate %d with wMaxPacketSize=%u , Interface = %d\n",
579 alt, max_pkt_size, usb_interface_index);
581 if (usb_interface_index > 0) {
582 status = usb_set_interface(dev->udev, usb_interface_index, alt);
585 ("cannot change interface %d alternate number to %d (error=%i)\n",
586 usb_interface_index, alt, status);
594 EXPORT_SYMBOL_GPL(cx231xx_set_alt_setting);
596 int cx231xx_gpio_set(struct cx231xx *dev, struct cx231xx_reg_seq *gpio)
603 /* Send GPIO reset sequences specified at board entry */
604 while (gpio->sleep >= 0) {
605 rc = cx231xx_set_gpio_value(dev, gpio->bit, gpio->val);
617 int cx231xx_set_mode(struct cx231xx *dev, enum cx231xx_mode set_mode)
619 if (dev->mode == set_mode)
622 if (set_mode == CX231XX_SUSPEND) {
623 /* Set the chip in power saving mode */
624 dev->mode = set_mode;
627 /* Resource is locked */
628 if (dev->mode != CX231XX_SUSPEND)
631 dev->mode = set_mode;
633 if (dev->mode == CX231XX_DIGITAL_MODE) {
634 /* Set Digital power mode */
636 /* Set Analog Power mode */
641 EXPORT_SYMBOL_GPL(cx231xx_set_mode);
643 /************************************************************************************
644 * URB Streaming functions *
645 *************************************************************************************/
648 * IRQ callback, called by URB callback
650 static void cx231xx_irq_callback(struct urb *urb)
652 struct cx231xx_dmaqueue *dma_q = urb->context;
653 struct cx231xx_video_mode *vmode =
654 container_of(dma_q, struct cx231xx_video_mode, vidq);
655 struct cx231xx *dev = container_of(vmode, struct cx231xx, video_mode);
658 switch (urb->status) {
659 case 0: /* success */
660 case -ETIMEDOUT: /* NAK */
662 case -ECONNRESET: /* kill */
667 cx231xx_isocdbg("urb completition error %d.\n", urb->status);
671 /* Copy data from URB */
672 spin_lock(&dev->video_mode.slock);
673 rc = dev->video_mode.isoc_ctl.isoc_copy(dev, urb);
674 spin_unlock(&dev->video_mode.slock);
676 /* Reset urb buffers */
677 for (i = 0; i < urb->number_of_packets; i++) {
678 urb->iso_frame_desc[i].status = 0;
679 urb->iso_frame_desc[i].actual_length = 0;
683 urb->status = usb_submit_urb(urb, GFP_ATOMIC);
685 cx231xx_isocdbg("urb resubmit failed (error=%i)\n",
691 * Stop and Deallocate URBs
693 void cx231xx_uninit_isoc(struct cx231xx *dev)
698 cx231xx_isocdbg("cx231xx: called cx231xx_uninit_isoc\n");
700 dev->video_mode.isoc_ctl.nfields = -1;
701 for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) {
702 urb = dev->video_mode.isoc_ctl.urb[i];
704 if (!irqs_disabled())
709 if (dev->video_mode.isoc_ctl.transfer_buffer[i]) {
710 usb_buffer_free(dev->udev,
711 urb->transfer_buffer_length,
712 dev->video_mode.isoc_ctl.
717 dev->video_mode.isoc_ctl.urb[i] = NULL;
719 dev->video_mode.isoc_ctl.transfer_buffer[i] = NULL;
722 kfree(dev->video_mode.isoc_ctl.urb);
723 kfree(dev->video_mode.isoc_ctl.transfer_buffer);
725 dev->video_mode.isoc_ctl.urb = NULL;
726 dev->video_mode.isoc_ctl.transfer_buffer = NULL;
727 dev->video_mode.isoc_ctl.num_bufs = 0;
729 cx231xx_capture_start(dev, 0, Raw_Video);
732 EXPORT_SYMBOL_GPL(cx231xx_uninit_isoc);
735 * Allocate URBs and start IRQ
737 int cx231xx_init_isoc(struct cx231xx *dev, int max_packets,
738 int num_bufs, int max_pkt_size,
739 int (*isoc_copy) (struct cx231xx * dev, struct urb * urb))
741 struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq;
748 cx231xx_isocdbg("cx231xx: called cx231xx_prepare_isoc\n");
750 dev->video_input = dev->video_input > 2 ? 2 : dev->video_input;
752 cx231xx_info("Setting Video mux to %d\n", dev->video_input);
753 video_mux(dev, dev->video_input);
755 /* De-allocates all pending stuff */
756 cx231xx_uninit_isoc(dev);
758 dev->video_mode.isoc_ctl.isoc_copy = isoc_copy;
759 dev->video_mode.isoc_ctl.num_bufs = num_bufs;
761 dma_q->is_partial_line = 0;
763 dma_q->current_field = -1;
764 dma_q->field1_done = 0;
765 dma_q->lines_per_field = dev->height / 2;
766 dma_q->bytes_left_in_line = dev->width << 1;
767 dma_q->lines_completed = 0;
768 for (i = 0; i < 8; i++)
769 dma_q->partial_buf[i] = 0;
771 dev->video_mode.isoc_ctl.urb =
772 kzalloc(sizeof(void *) * num_bufs, GFP_KERNEL);
773 if (!dev->video_mode.isoc_ctl.urb) {
774 cx231xx_errdev("cannot alloc memory for usb buffers\n");
778 dev->video_mode.isoc_ctl.transfer_buffer =
779 kzalloc(sizeof(void *) * num_bufs, GFP_KERNEL);
780 if (!dev->video_mode.isoc_ctl.transfer_buffer) {
781 cx231xx_errdev("cannot allocate memory for usbtransfer\n");
782 kfree(dev->video_mode.isoc_ctl.urb);
786 dev->video_mode.isoc_ctl.max_pkt_size = max_pkt_size;
787 dev->video_mode.isoc_ctl.buf = NULL;
789 sb_size = max_packets * dev->video_mode.isoc_ctl.max_pkt_size;
791 /* allocate urbs and transfer buffers */
792 for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) {
793 urb = usb_alloc_urb(max_packets, GFP_KERNEL);
795 cx231xx_err("cannot alloc isoc_ctl.urb %i\n", i);
796 cx231xx_uninit_isoc(dev);
799 dev->video_mode.isoc_ctl.urb[i] = urb;
801 dev->video_mode.isoc_ctl.transfer_buffer[i] =
802 usb_buffer_alloc(dev->udev, sb_size, GFP_KERNEL,
804 if (!dev->video_mode.isoc_ctl.transfer_buffer[i]) {
805 cx231xx_err("unable to allocate %i bytes for transfer"
808 in_interrupt()? " while in int" : "");
809 cx231xx_uninit_isoc(dev);
812 memset(dev->video_mode.isoc_ctl.transfer_buffer[i], 0, sb_size);
815 usb_rcvisocpipe(dev->udev, dev->video_mode.end_point_addr);
817 usb_fill_int_urb(urb, dev->udev, pipe,
818 dev->video_mode.isoc_ctl.transfer_buffer[i],
819 sb_size, cx231xx_irq_callback, dma_q, 1);
821 urb->number_of_packets = max_packets;
822 urb->transfer_flags = URB_ISO_ASAP;
825 for (j = 0; j < max_packets; j++) {
826 urb->iso_frame_desc[j].offset = k;
827 urb->iso_frame_desc[j].length =
828 dev->video_mode.isoc_ctl.max_pkt_size;
829 k += dev->video_mode.isoc_ctl.max_pkt_size;
833 init_waitqueue_head(&dma_q->wq);
835 /* submit urbs and enables IRQ */
836 for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) {
837 rc = usb_submit_urb(dev->video_mode.isoc_ctl.urb[i],
840 cx231xx_err("submit of urb %i failed (error=%i)\n", i,
842 cx231xx_uninit_isoc(dev);
847 cx231xx_capture_start(dev, 1, Raw_Video);
852 EXPORT_SYMBOL_GPL(cx231xx_init_isoc);
854 /************************************************************************************
855 * Device Init/UnInit functions *
856 *************************************************************************************/
857 int cx231xx_dev_init(struct cx231xx *dev)
861 /* Initialize I2C bus */
863 /* External Master 1 Bus */
864 dev->i2c_bus[0].nr = 0;
865 dev->i2c_bus[0].dev = dev;
866 dev->i2c_bus[0].i2c_period = I2C_SPEED_1M; /* 1MHz */
867 dev->i2c_bus[0].i2c_nostop = 0;
868 dev->i2c_bus[0].i2c_reserve = 0;
870 /* External Master 2 Bus */
871 dev->i2c_bus[1].nr = 1;
872 dev->i2c_bus[1].dev = dev;
873 dev->i2c_bus[1].i2c_period = I2C_SPEED_1M; /* 1MHz */
874 dev->i2c_bus[1].i2c_nostop = 0;
875 dev->i2c_bus[1].i2c_reserve = 0;
877 /* Internal Master 3 Bus */
878 dev->i2c_bus[2].nr = 2;
879 dev->i2c_bus[2].dev = dev;
880 dev->i2c_bus[2].i2c_period = I2C_SPEED_400K; /* 400kHz */
881 dev->i2c_bus[2].i2c_nostop = 0;
882 dev->i2c_bus[2].i2c_reserve = 0;
884 /* register I2C buses */
885 cx231xx_i2c_register(&dev->i2c_bus[0]);
886 cx231xx_i2c_register(&dev->i2c_bus[1]);
887 cx231xx_i2c_register(&dev->i2c_bus[2]);
890 /* Note : with out calling set power mode function, colibri can not be set up correctly */
891 errCode = cx231xx_set_power_mode(dev, POLARIS_AVMODE_ANALOGT_TV);
894 ("%s: cx231xx_set_power_mode : Failed to set Power - errCode [%d]!\n",
899 /* initialize Colibri block */
900 errCode = cx231xx_colibri_init_super_block(dev, 0x23c);
903 ("%s: cx231xx_colibri init super block - errCode [%d]!\n",
907 errCode = cx231xx_colibri_init_channels(dev);
910 ("%s: cx231xx_colibri init channels - errCode [%d]!\n",
915 /* Set DIF in By pass mode */
916 errCode = cx231xx_dif_set_standard(dev, DIF_USE_BASEBAND);
919 ("%s: cx231xx_dif set to By pass mode - errCode [%d]!\n",
924 /* flatiron related functions */
925 errCode = cx231xx_flatiron_initialize(dev);
928 ("%s: cx231xx_flatiron initialize - errCode [%d]!\n",
933 /* init control pins */
934 errCode = cx231xx_init_ctrl_pin_status(dev);
936 cx231xx_errdev("%s: cx231xx_init ctrl pins - errCode [%d]!\n",
941 /* set AGC mode to Analog */
942 errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 1);
945 ("%s: cx231xx_AGC mode to Analog - errCode [%d]!\n",
950 /* set all alternate settings to zero initially */
951 cx231xx_set_alt_setting(dev, INDEX_VIDEO, 0);
952 cx231xx_set_alt_setting(dev, INDEX_VANC, 0);
953 cx231xx_set_alt_setting(dev, INDEX_HANC, 0);
954 if (dev->board.has_dvb)
955 cx231xx_set_alt_setting(dev, INDEX_TS1, 0);
957 /* set the I2C master port to 3 on channel 1 */
958 errCode = cx231xx_enable_i2c_for_tuner(dev, I2C_3);
963 EXPORT_SYMBOL_GPL(cx231xx_dev_init);
965 void cx231xx_dev_uninit(struct cx231xx *dev)
967 /* Un Initialize I2C bus */
968 cx231xx_i2c_unregister(&dev->i2c_bus[2]);
969 cx231xx_i2c_unregister(&dev->i2c_bus[1]);
970 cx231xx_i2c_unregister(&dev->i2c_bus[0]);
973 EXPORT_SYMBOL_GPL(cx231xx_dev_uninit);
975 /************************************************************************************
976 * G P I O related functions *
977 *************************************************************************************/
978 int cx231xx_send_gpio_cmd(struct cx231xx *dev, u32 gpio_bit, u8 * gpio_val,
979 u8 len, u8 request, u8 direction)
982 VENDOR_REQUEST_IN ven_req;
985 ven_req.wValue = (u16) (gpio_bit >> 16 & 0xffff);
990 ven_req.bRequest = VRT_GET_GPIO; /* 0x8 gpio */
992 ven_req.bRequest = VRT_SET_GPIO; /* 0x9 gpio */
995 ven_req.bRequest = VRT_GET_GPIE; /* 0xa gpie */
997 ven_req.bRequest = VRT_SET_GPIE; /* 0xb gpie */
1000 /* set index value */
1001 ven_req.wIndex = (u16) (gpio_bit & 0xffff);
1003 /* set wLength value */
1004 ven_req.wLength = len;
1006 /* set bData value */
1009 /* set the buffer for read / write */
1010 ven_req.pBuff = gpio_val;
1012 /* set the direction */
1014 ven_req.direction = USB_DIR_IN;
1015 memset(ven_req.pBuff, 0x00, ven_req.wLength);
1017 ven_req.direction = USB_DIR_OUT;
1020 /* call common vendor command request */
1021 status = cx231xx_send_vendor_cmd(dev, &ven_req);
1024 ("UsbInterface::sendCommand, output buffer failed with status -%d\n",
1031 EXPORT_SYMBOL_GPL(cx231xx_send_gpio_cmd);
1033 /*************************************************************************************
1034 * C O N T R O L - Register R E A D / W R I T E functions *
1035 *************************************************************************************/
1036 int cx231xx_mode_register(struct cx231xx *dev, u16 address, u32 mode)
1038 u8 value[4] = { 0x0, 0x0, 0x0, 0x0 };
1043 cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, address, value, 4);
1047 tmp = *((u32 *) value);
1050 value[0] = (u8) tmp;
1051 value[1] = (u8) (tmp >> 8);
1052 value[2] = (u8) (tmp >> 16);
1053 value[3] = (u8) (tmp >> 24);
1056 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, address, value, 4);
1061 /*************************************************************************************
1062 * I 2 C Internal C O N T R O L functions *
1063 *************************************************************************************/
1064 int cx231xx_read_i2c_data(struct cx231xx *dev, u8 dev_addr, u16 saddr,
1065 u8 saddr_len, u32 * data, u8 data_len)
1068 struct cx231xx_i2c_xfer_data req_data;
1069 u8 value[4] = { 0, 0, 0, 0 };
1073 else if (saddr_len == 0)
1076 /* prepare xfer_data struct */
1077 req_data.dev_addr = dev_addr >> 1;
1078 req_data.direction = I2C_M_RD;
1079 req_data.saddr_len = saddr_len;
1080 req_data.saddr_dat = saddr;
1081 req_data.buf_size = data_len;
1082 req_data.p_buffer = (u8 *) value;
1084 /* usb send command */
1085 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], &req_data);
1088 /* Copy the data read back to main buffer */
1093 value[0] | value[1] << 8 | value[2] << 16 | value[3]
1100 int cx231xx_write_i2c_data(struct cx231xx *dev, u8 dev_addr, u16 saddr,
1101 u8 saddr_len, u32 data, u8 data_len)
1104 u8 value[4] = { 0, 0, 0, 0 };
1105 struct cx231xx_i2c_xfer_data req_data;
1107 value[0] = (u8) data;
1108 value[1] = (u8) (data >> 8);
1109 value[2] = (u8) (data >> 16);
1110 value[3] = (u8) (data >> 24);
1114 else if (saddr_len == 0)
1117 /* prepare xfer_data struct */
1118 req_data.dev_addr = dev_addr >> 1;
1119 req_data.direction = 0;
1120 req_data.saddr_len = saddr_len;
1121 req_data.saddr_dat = saddr;
1122 req_data.buf_size = data_len;
1123 req_data.p_buffer = value;
1125 /* usb send command */
1126 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], &req_data);
1131 int cx231xx_reg_mask_write(struct cx231xx *dev, u8 dev_addr, u8 size,
1132 u16 register_address, u8 bit_start, u8 bit_end,
1140 if (bit_start > (size - 1) || bit_end > (size - 1)) {
1146 cx231xx_read_i2c_data(dev, dev_addr, register_address, 2,
1150 cx231xx_read_i2c_data(dev, dev_addr, register_address, 2,
1158 mask = 1 << bit_end;
1159 for (i = bit_end; i > bit_start && i > 0; i--) {
1160 mask = mask + (1 << (i - 1));
1163 value <<= bit_start;
1170 cx231xx_write_i2c_data(dev, dev_addr, register_address, 2,
1176 cx231xx_write_i2c_data(dev, dev_addr, register_address, 2,
1183 int cx231xx_read_modify_write_i2c_dword(struct cx231xx *dev, u8 dev_addr,
1184 u16 saddr, u32 mask, u32 value)
1189 status = cx231xx_read_i2c_data(dev, dev_addr, saddr, 2, &temp, 4);
1197 status = cx231xx_write_i2c_data(dev, dev_addr, saddr, 2, temp, 4);
1202 u32 cx231xx_set_field(u32 field_mask, u32 data)
1206 for (temp = field_mask; (temp & 1) == 0; temp >>= 1) {