V4L/DVB (11130): cx231xx: fix an inverted logic at vidioc_streamoff
[linux-2.6-block.git] / drivers / media / video / cx231xx / cx231xx-cards.c
CommitLineData
e0d3bafd 1/*
b9255176
SD
2 cx231xx-cards.c - driver for Conexant Cx23100/101/102
3 USB video capture devices
e0d3bafd
SD
4
5 Copyright (C) 2008 <srinivasa.deevi at conexant dot com>
b9255176 6 Based on em28xx driver
e0d3bafd
SD
7
8 This program is free software; you can redistribute it and/or modify
9 it under the terms of the GNU General Public License as published by
10 the Free Software Foundation; either version 2 of the License, or
11 (at your option) any later version.
12
13 This program is distributed in the hope that it will be useful,
14 but WITHOUT ANY WARRANTY; without even the implied warranty of
15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 GNU General Public License for more details.
17
18 You should have received a copy of the GNU General Public License
19 along with this program; if not, write to the Free Software
20 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21 */
22
23#include <linux/init.h>
24#include <linux/module.h>
25#include <linux/delay.h>
26#include <linux/i2c.h>
27#include <linux/usb.h>
28#include <media/tuner.h>
29#include <media/tveeprom.h>
30#include <media/v4l2-common.h>
31#include <media/v4l2-chip-ident.h>
32
33#include <media/cx25840.h>
34#include "xc5000.h"
35
36#include "cx231xx.h"
37
38static int tuner = -1;
39module_param(tuner, int, 0444);
40MODULE_PARM_DESC(tuner, "tuner type");
41
42static unsigned int disable_ir;
43module_param(disable_ir, int, 0444);
44MODULE_PARM_DESC(disable_ir, "disable infrared remote support");
45
46/* Bitmask marking allocated devices from 0 to CX231XX_MAXBOARDS */
47static unsigned long cx231xx_devused;
48
49/*
50 * Reset sequences for analog/digital modes
51 */
52
53static struct cx231xx_reg_seq RDE250_XCV_TUNER[] = {
84b5dbf3
MCC
54 {0x03, 0x01, 10},
55 {0x03, 0x00, 30},
56 {0x03, 0x01, 10},
57 {-1, -1, -1},
e0d3bafd
SD
58};
59
e0d3bafd
SD
60/*
61 * Board definitions
62 */
63struct cx231xx_board cx231xx_boards[] = {
e0d3bafd 64 [CX231XX_BOARD_UNKNOWN] = {
6e4f574b
SD
65 .name = "Unknown CX231xx video grabber",
66 .tuner_type = TUNER_ABSENT,
67 .input = {{
68 .type = CX231XX_VMUX_TELEVISION,
69 .vmux = CX231XX_VIN_3_1,
70 .amux = CX231XX_AMUX_VIDEO,
71 .gpio = 0,
72 }, {
73 .type = CX231XX_VMUX_COMPOSITE1,
74 .vmux = CX231XX_VIN_2_1,
75 .amux = CX231XX_AMUX_LINE_IN,
76 .gpio = 0,
77 }, {
78 .type = CX231XX_VMUX_SVIDEO,
79 .vmux = CX231XX_VIN_1_1 |
80 (CX231XX_VIN_1_2 << 8) |
81 CX25840_SVIDEO_ON,
82 .amux = CX231XX_AMUX_LINE_IN,
83 .gpio = 0,
84 }
85 },
86 },
e0d3bafd 87 [CX231XX_BOARD_CNXT_RDE_250] = {
6e4f574b
SD
88 .name = "Conexant Hybrid TV - RDE250",
89 .tuner_type = TUNER_XC5000,
90 .tuner_addr = 0x61,
91 .tuner_gpio = RDE250_XCV_TUNER,
92 .tuner_sif_gpio = 0x05,
93 .tuner_scl_gpio = 0x1a,
94 .tuner_sda_gpio = 0x1b,
95 .decoder = CX231XX_AVDECODER,
96 .demod_xfer_mode = 0,
97 .ctl_pin_status_mask = 0xFFFFFFC4,
98 .agc_analog_digital_select_gpio = 0x0c,
99 .gpio_pin_status_mask = 0x4001000,
100 .tuner_i2c_master = 1,
101 .demod_i2c_master = 2,
102 .has_dvb = 1,
103 .demod_addr = 0x02,
104 .norm = V4L2_STD_PAL,
105
106 .input = {{
107 .type = CX231XX_VMUX_TELEVISION,
108 .vmux = CX231XX_VIN_3_1,
109 .amux = CX231XX_AMUX_VIDEO,
110 .gpio = 0,
111 }, {
112 .type = CX231XX_VMUX_COMPOSITE1,
113 .vmux = CX231XX_VIN_2_1,
114 .amux = CX231XX_AMUX_LINE_IN,
115 .gpio = 0,
116 }, {
117 .type = CX231XX_VMUX_SVIDEO,
118 .vmux = CX231XX_VIN_1_1 |
119 (CX231XX_VIN_1_2 << 8) |
120 CX25840_SVIDEO_ON,
121 .amux = CX231XX_AMUX_LINE_IN,
122 .gpio = 0,
123 }
124 },
125 },
84b5dbf3
MCC
126
127 [CX231XX_BOARD_CNXT_RDU_250] = {
6e4f574b
SD
128 .name = "Conexant Hybrid TV - RDU250",
129 .tuner_type = TUNER_XC5000,
130 .tuner_addr = 0x61,
131 .tuner_gpio = RDE250_XCV_TUNER,
132 .tuner_sif_gpio = 0x05,
133 .tuner_scl_gpio = 0x1a,
134 .tuner_sda_gpio = 0x1b,
135 .decoder = CX231XX_AVDECODER,
136 .demod_xfer_mode = 0,
137 .ctl_pin_status_mask = 0xFFFFFFC4,
138 .agc_analog_digital_select_gpio = 0x0c,
139 .gpio_pin_status_mask = 0x4001000,
140 .tuner_i2c_master = 1,
141 .demod_i2c_master = 2,
142 .has_dvb = 1,
143 .demod_addr = 0x32,
144 .norm = V4L2_STD_NTSC,
145
146 .input = {{
147 .type = CX231XX_VMUX_TELEVISION,
148 .vmux = CX231XX_VIN_3_1,
149 .amux = CX231XX_AMUX_VIDEO,
150 .gpio = 0,
151 }, {
152 .type = CX231XX_VMUX_COMPOSITE1,
153 .vmux = CX231XX_VIN_2_1,
154 .amux = CX231XX_AMUX_LINE_IN,
155 .gpio = 0,
156 }, {
157 .type = CX231XX_VMUX_SVIDEO,
158 .vmux = CX231XX_VIN_1_1 |
159 (CX231XX_VIN_1_2 << 8) |
160 CX25840_SVIDEO_ON,
161 .amux = CX231XX_AMUX_LINE_IN,
162 .gpio = 0,
163 }
164 },
165 },
e0d3bafd
SD
166};
167const unsigned int cx231xx_bcount = ARRAY_SIZE(cx231xx_boards);
168
169/* table of devices that work with this driver */
84b5dbf3 170struct usb_device_id cx231xx_id_table[] = {
ed559edf 171 {USB_DEVICE(0x0572, 0x5A3C),
84b5dbf3
MCC
172 .driver_info = CX231XX_BOARD_UNKNOWN},
173 {USB_DEVICE(0x0572, 0x58A2),
174 .driver_info = CX231XX_BOARD_CNXT_RDE_250},
ed559edf 175 {USB_DEVICE(0x0572, 0x58A1),
84b5dbf3
MCC
176 .driver_info = CX231XX_BOARD_CNXT_RDU_250},
177 {},
e0d3bafd 178};
84b5dbf3 179
e0d3bafd
SD
180MODULE_DEVICE_TABLE(usb, cx231xx_id_table);
181
182/* cx231xx_tuner_callback
183 * will be used to reset XC5000 tuner using GPIO pin
184 */
185
186int cx231xx_tuner_callback(void *ptr, int component, int command, int arg)
187{
188 int rc = 0;
189 struct cx231xx *dev = ptr;
190
84b5dbf3
MCC
191 if (dev->tuner_type == TUNER_XC5000) {
192 if (command == XC5000_TUNER_RESET) {
193 cx231xx_info
b9255176
SD
194 ("Tuner CB: RESET: cmd %d : tuner type %d \n",
195 command, dev->tuner_type);
84b5dbf3
MCC
196 cx231xx_set_gpio_value(dev, dev->board.tuner_gpio->bit,
197 1);
198 msleep(10);
199 cx231xx_set_gpio_value(dev, dev->board.tuner_gpio->bit,
200 0);
201 msleep(330);
202 cx231xx_set_gpio_value(dev, dev->board.tuner_gpio->bit,
203 1);
204 msleep(10);
205 }
206 }
e0d3bafd
SD
207 return rc;
208}
209EXPORT_SYMBOL_GPL(cx231xx_tuner_callback);
210
b9255176 211static inline void cx231xx_set_model(struct cx231xx *dev)
e0d3bafd
SD
212{
213 memcpy(&dev->board, &cx231xx_boards[dev->model], sizeof(dev->board));
214}
215
216/* Since cx231xx_pre_card_setup() requires a proper dev->model,
217 * this won't work for boards with generic PCI IDs
218 */
219void cx231xx_pre_card_setup(struct cx231xx *dev)
220{
221
222 cx231xx_set_model(dev);
223
224 cx231xx_info("Identified as %s (card=%d)\n",
84b5dbf3 225 dev->board.name, dev->model);
e0d3bafd 226
6e4f574b
SD
227 cx231xx_info("Precard: Board is %s\n", dev->board.name);
228 /* set the direction for GPIO pins */
229 cx231xx_set_gpio_direction(dev, dev->board.tuner_gpio->bit, 1);
230 cx231xx_set_gpio_value(dev, dev->board.tuner_gpio->bit, 1);
231 cx231xx_set_gpio_direction(dev, dev->board.tuner_sif_gpio, 1);
e0d3bafd
SD
232
233 /* request some modules if any required */
234
84b5dbf3 235 /* reset the Tuner */
e0d3bafd
SD
236 cx231xx_gpio_set(dev, dev->board.tuner_gpio);
237
84b5dbf3 238 /* set the mode to Analog mode initially */
e0d3bafd
SD
239 cx231xx_set_mode(dev, CX231XX_ANALOG_MODE);
240
241 /* Unlock device */
242 /* cx231xx_set_mode(dev, CX231XX_SUSPEND); */
243
244}
245
e0d3bafd
SD
246static void cx231xx_config_tuner(struct cx231xx *dev)
247{
84b5dbf3
MCC
248 struct tuner_setup tun_setup;
249 struct v4l2_frequency f;
e0d3bafd
SD
250
251 if (dev->tuner_type == TUNER_ABSENT)
252 return;
253
254 tun_setup.mode_mask = T_ANALOG_TV | T_RADIO;
255 tun_setup.type = dev->tuner_type;
256 tun_setup.addr = dev->tuner_addr;
257 tun_setup.tuner_callback = cx231xx_tuner_callback;
258
b1196126
SD
259 tuner_call(dev, tuner, s_type_addr, &tun_setup);
260
e0d3bafd 261#if 0
84b5dbf3 262 if (tun_setup.type == TUNER_XC5000) {
e0d3bafd
SD
263 static struct xc2028_ctrl ctrl = {
264 .fname = XC5000_DEFAULT_FIRMWARE,
265 .max_len = 64,
84b5dbf3 266 .demod = 0;
e0d3bafd
SD
267 };
268 struct v4l2_priv_tun_config cfg = {
269 .tuner = dev->tuner_type,
270 .priv = &ctrl,
271 };
b1196126 272 tuner_call(dev, tuner, s_config, &cfg);
e0d3bafd
SD
273 }
274#endif
e0d3bafd
SD
275 /* configure tuner */
276 f.tuner = 0;
277 f.type = V4L2_TUNER_ANALOG_TV;
84b5dbf3 278 f.frequency = 9076; /* just a magic number */
e0d3bafd 279 dev->ctl_freq = f.frequency;
b1196126 280 call_all(dev, tuner, s_frequency, &f);
e0d3bafd 281
b1196126 282}
e0d3bafd
SD
283
284/* ----------------------------------------------------------------------- */
285void cx231xx_set_ir(struct cx231xx *dev, struct IR_i2c *ir)
286{
287 if (disable_ir) {
288 ir->get_key = NULL;
84b5dbf3 289 return;
e0d3bafd
SD
290 }
291
292 /* detect & configure */
293 switch (dev->model) {
294
84b5dbf3
MCC
295 case CX231XX_BOARD_CNXT_RDE_250:
296 break;
297 case CX231XX_BOARD_CNXT_RDU_250:
298 break;
299 default:
300 break;
e0d3bafd
SD
301 }
302}
303
304void cx231xx_card_setup(struct cx231xx *dev)
305{
b1196126 306
e0d3bafd
SD
307 cx231xx_set_model(dev);
308
309 dev->tuner_type = cx231xx_boards[dev->model].tuner_type;
310 if (cx231xx_boards[dev->model].tuner_addr)
311 dev->tuner_addr = cx231xx_boards[dev->model].tuner_addr;
312
84b5dbf3
MCC
313 cx231xx_info(": tuner type %d, tuner address %d \n",
314 dev->tuner_type, dev->tuner_addr);
e0d3bafd
SD
315
316 /* Do card specific if any */
317 switch (dev->model) {
84b5dbf3
MCC
318 case CX231XX_BOARD_CNXT_RDE_250:
319 /* do card specific GPIO settings if required */
ed559edf 320 cx231xx_info("Board is Conexant RDE 250\n");
84b5dbf3
MCC
321 break;
322 case CX231XX_BOARD_CNXT_RDU_250:
323 /* do card specific GPIO settings if required */
ed559edf 324 cx231xx_info("Board is Conexant RDU 250\n");
84b5dbf3 325 break;
e0d3bafd
SD
326 }
327
e0d3bafd 328 /* request some modules */
84b5dbf3
MCC
329 if (dev->board.decoder == CX231XX_AVDECODER) {
330 cx231xx_info(": Requesting cx25840 module\n");
b1196126
SD
331 dev->sd_cx25840 =
332 v4l2_i2c_new_subdev(&dev->i2c_bus[0].i2c_adap,
333 "cx25840", "cx25840", 0x88 >> 1);
334 if (dev->sd_cx25840 == NULL)
335 cx231xx_info("cx25840 subdev registration failure\n");
336 cx25840_call(dev, core, init, 0);
337
84b5dbf3 338 }
b1196126 339
84b5dbf3
MCC
340 if (dev->board.tuner_type != TUNER_ABSENT) {
341 cx231xx_info(": Requesting Tuner module\n");
b1196126
SD
342 dev->sd_tuner =
343 v4l2_i2c_new_subdev(&dev->i2c_bus[1].i2c_adap,
344 "tuner", "tuner", 0xc2 >> 1);
345 if (dev->sd_tuner == NULL)
346 cx231xx_info("tuner subdev registration failure\n");
347
348 cx231xx_config_tuner(dev);
84b5dbf3 349 }
e0d3bafd
SD
350
351 cx231xx_config_tuner(dev);
352
b1196126 353#if 0
84b5dbf3 354 /* TBD IR will be added later */
e0d3bafd
SD
355 cx231xx_ir_init(dev);
356#endif
357}
358
e0d3bafd
SD
359/*
360 * cx231xx_config()
361 * inits registers with sane defaults
362 */
363int cx231xx_config(struct cx231xx *dev)
364{
84b5dbf3 365 /* TBD need to add cx231xx specific code */
e0d3bafd
SD
366 dev->mute = 1; /* maybe not the right place... */
367 dev->volume = 0x1f;
368
369 return 0;
370}
371
372/*
373 * cx231xx_config_i2c()
374 * configure i2c attached devices
375 */
376void cx231xx_config_i2c(struct cx231xx *dev)
377{
378 struct v4l2_routing route;
379
380 route.input = INPUT(dev->video_input)->vmux;
381 route.output = 0;
382
b1196126 383 call_all(dev, video, s_stream, 1);
e0d3bafd
SD
384}
385
386/*
387 * cx231xx_realease_resources()
388 * unregisters the v4l2,i2c and usb devices
389 * called when the device gets disconected or at module unload
390*/
391void cx231xx_release_resources(struct cx231xx *dev)
392{
393
84b5dbf3 394#if 0 /* TBD IR related */
e0d3bafd
SD
395 if (dev->ir)
396 cx231xx_ir_fini(dev);
397#endif
398
399 cx231xx_release_analog_resources(dev);
400
84b5dbf3 401 cx231xx_remove_from_devlist(dev);
e0d3bafd 402
84b5dbf3 403 cx231xx_dev_uninit(dev);
e0d3bafd
SD
404
405 usb_put_dev(dev->udev);
406
407 /* Mark device as unused */
84b5dbf3 408 cx231xx_devused &= ~(1 << dev->devno);
e0d3bafd
SD
409}
410
e0d3bafd
SD
411/*
412 * cx231xx_init_dev()
413 * allocates and inits the device structs, registers i2c bus and v4l device
414 */
415static int cx231xx_init_dev(struct cx231xx **devhandle, struct usb_device *udev,
84b5dbf3 416 int minor)
e0d3bafd
SD
417{
418 struct cx231xx *dev = *devhandle;
419 int retval = -ENOMEM;
420 int errCode;
421 unsigned int maxh, maxw;
422
423 dev->udev = udev;
424 mutex_init(&dev->lock);
425 mutex_init(&dev->ctrl_urb_lock);
84b5dbf3 426 mutex_init(&dev->gpio_i2c_lock);
e0d3bafd 427
84b5dbf3
MCC
428 spin_lock_init(&dev->video_mode.slock);
429 spin_lock_init(&dev->vbi_mode.slock);
430 spin_lock_init(&dev->sliced_cc_mode.slock);
e0d3bafd
SD
431
432 init_waitqueue_head(&dev->open);
433 init_waitqueue_head(&dev->wait_frame);
434 init_waitqueue_head(&dev->wait_stream);
435
84b5dbf3
MCC
436 dev->cx231xx_read_ctrl_reg = cx231xx_read_ctrl_reg;
437 dev->cx231xx_write_ctrl_reg = cx231xx_write_ctrl_reg;
438 dev->cx231xx_send_usb_command = cx231xx_send_usb_command;
439 dev->cx231xx_gpio_i2c_read = cx231xx_gpio_i2c_read;
440 dev->cx231xx_gpio_i2c_write = cx231xx_gpio_i2c_write;
e0d3bafd 441
84b5dbf3
MCC
442 /* Query cx231xx to find what pcb config it is related to */
443 initialize_cx231xx(dev);
e0d3bafd 444
84b5dbf3 445 /* Cx231xx pre card setup */
e0d3bafd
SD
446 cx231xx_pre_card_setup(dev);
447
448 errCode = cx231xx_config(dev);
449 if (errCode) {
450 cx231xx_errdev("error configuring device\n");
451 return -ENOMEM;
452 }
453
84b5dbf3 454 /* set default norm */
e0d3bafd
SD
455 dev->norm = dev->board.norm;
456
457 /* register i2c bus */
458 errCode = cx231xx_dev_init(dev);
459 if (errCode < 0) {
460 cx231xx_errdev("%s: cx231xx_i2c_register - errCode [%d]!\n",
84b5dbf3 461 __func__, errCode);
e0d3bafd
SD
462 return errCode;
463 }
464
465 /* Do board specific init */
466 cx231xx_card_setup(dev);
467
468 /* configure the device */
469 cx231xx_config_i2c(dev);
470
471 maxw = norm_maxw(dev);
472 maxh = norm_maxh(dev);
473
474 /* set default image size */
475 dev->width = maxw;
476 dev->height = maxh;
477 dev->interlaced = 0;
478 dev->hscale = 0;
479 dev->vscale = 0;
480 dev->video_input = 0;
481
482 errCode = cx231xx_config(dev);
483 if (errCode < 0) {
484 cx231xx_errdev("%s: cx231xx_config - errCode [%d]!\n",
84b5dbf3 485 __func__, errCode);
e0d3bafd
SD
486 return errCode;
487 }
488
489 /* init video dma queues */
490 INIT_LIST_HEAD(&dev->video_mode.vidq.active);
491 INIT_LIST_HEAD(&dev->video_mode.vidq.queued);
492
84b5dbf3 493 /* init vbi dma queues */
e0d3bafd
SD
494 INIT_LIST_HEAD(&dev->vbi_mode.vidq.active);
495 INIT_LIST_HEAD(&dev->vbi_mode.vidq.queued);
496
497 /* Reset other chips required if they are tied up with GPIO pins */
498
84b5dbf3 499 cx231xx_add_into_devlist(dev);
e0d3bafd
SD
500
501 retval = cx231xx_register_analog_devices(dev);
502 if (retval < 0) {
503 cx231xx_release_resources(dev);
504 goto fail_reg_devices;
505 }
506
507 cx231xx_init_extension(dev);
508
509 return 0;
510
b9255176 511fail_reg_devices:
e0d3bafd
SD
512 mutex_unlock(&dev->lock);
513 return retval;
514}
515
516#if defined(CONFIG_MODULES) && defined(MODULE)
517static void request_module_async(struct work_struct *work)
518{
519 struct cx231xx *dev = container_of(work,
84b5dbf3 520 struct cx231xx, request_module_wk);
e0d3bafd
SD
521
522 if (dev->has_alsa_audio)
523 request_module("cx231xx-alsa");
524
525 if (dev->board.has_dvb)
526 request_module("cx231xx-dvb");
527
528}
529
530static void request_modules(struct cx231xx *dev)
531{
532 INIT_WORK(&dev->request_module_wk, request_module_async);
533 schedule_work(&dev->request_module_wk);
534}
535#else
536#define request_modules(dev)
537#endif /* CONFIG_MODULES */
538
e0d3bafd
SD
539/*
540 * cx231xx_usb_probe()
541 * checks for supported devices
542 */
543static int cx231xx_usb_probe(struct usb_interface *interface,
84b5dbf3 544 const struct usb_device_id *id)
e0d3bafd
SD
545{
546 struct usb_device *udev;
547 struct usb_interface *uif;
548 struct cx231xx *dev = NULL;
549 int retval = -ENODEV;
d73abcff 550 int nr = 0, ifnum;
e0d3bafd
SD
551 int i, isoc_pipe = 0;
552 char *speed;
553 char descr[255] = "";
84b5dbf3
MCC
554 struct usb_interface *lif = NULL;
555 int skip_interface = 0;
556 struct usb_interface_assoc_descriptor *assoc_desc;
e0d3bafd
SD
557
558 udev = usb_get_dev(interface_to_usbdev(interface));
559 ifnum = interface->altsetting[0].desc.bInterfaceNumber;
560
b1196126 561 printk(DRIVER_NAME ": Interface Number %d\n", ifnum);
84b5dbf3
MCC
562
563 /* Interface number 0 - IR interface */
564 if (ifnum == 0) {
565 /* Check to see next free device and mark as used */
566 nr = find_first_zero_bit(&cx231xx_devused, CX231XX_MAXBOARDS);
567 cx231xx_devused |= 1 << nr;
568
569 if (nr >= CX231XX_MAXBOARDS) {
570 cx231xx_info(": Supports only %i cx231xx boards.\n",
571 CX231XX_MAXBOARDS);
572 cx231xx_devused &= ~(1 << nr);
573 return -ENOMEM;
574 }
575
576 /* allocate memory for our device state and initialize it */
577 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
578 if (dev == NULL) {
579 cx231xx_err(DRIVER_NAME ": out of memory!\n");
580 cx231xx_devused &= ~(1 << nr);
581 return -ENOMEM;
582 }
583
584 snprintf(dev->name, 29, "cx231xx #%d", nr);
585 dev->devno = nr;
586 dev->model = id->driver_info;
587 dev->video_mode.alt = -1;
588 dev->interface_count++;
589
590 /* reset gpio dir and value */
591 dev->gpio_dir = 0;
592 dev->gpio_val = 0;
593 dev->xc_fw_load_done = 0;
e0d3bafd 594 dev->has_alsa_audio = 1;
84b5dbf3
MCC
595 dev->power_mode = -1;
596
b9255176
SD
597 /* 0 - vbi ; 1 -sliced cc mode */
598 dev->vbi_or_sliced_cc_mode = 0;
84b5dbf3
MCC
599
600 /* get maximum no.of IAD interfaces */
601 assoc_desc = udev->actconfig->intf_assoc[0];
602 dev->max_iad_interface_count = assoc_desc->bInterfaceCount;
b9255176 603 cx231xx_info("Found IAD interface count %d\n",
84b5dbf3
MCC
604 dev->max_iad_interface_count);
605
606 /* init CIR module TBD */
607
608 /* store the current interface */
609 lif = interface;
610
611 } else if (ifnum == 1) {
612
613 /* Get dev structure first */
614 dev = usb_get_intfdata(udev->actconfig->interface[0]);
615 if (dev == NULL) {
616 cx231xx_err(DRIVER_NAME ": out of first interface!\n");
617 return -ENODEV;
618 }
619
620 /* store the interface 0 back */
621 lif = udev->actconfig->interface[0];
622
623 /* increment interface count */
624 dev->interface_count++;
625
626 /* get device number */
627 nr = dev->devno;
628
629 assoc_desc = udev->actconfig->intf_assoc[0];
630 if (assoc_desc->bFirstInterface == ifnum) {
631 cx231xx_info
b9255176 632 ("Found IAD interface match: AV Desc Start!! \n");
84b5dbf3 633 } else {
b9255176 634 cx231xx_err(" Not found matching interface\n");
84b5dbf3
MCC
635 return -ENODEV;
636 }
637
638 } else if (ifnum >= 2) {
639 /* Get dev structure first */
640 dev = usb_get_intfdata(udev->actconfig->interface[0]);
641 if (dev == NULL) {
642 cx231xx_err(DRIVER_NAME ": out of first interface!\n");
643 return -ENODEV;
644 }
645
646 /* store the interface 0 back */
647 lif = udev->actconfig->interface[0];
648
649 /* increment interface count */
650 dev->interface_count++;
651
652 /* get device number */
653 nr = dev->devno;
654
655 /* set skip interface */
656 if ((dev->interface_count - 1) != dev->max_iad_interface_count)
657 skip_interface = 1; /* set skipping */
658 else {
659 cx231xx_info
b9255176 660 ("Found IAD interface no. match with AV Device no.!\n");
84b5dbf3
MCC
661 }
662 }
e0d3bafd
SD
663
664 switch (udev->speed) {
665 case USB_SPEED_LOW:
666 speed = "1.5";
667 break;
668 case USB_SPEED_UNKNOWN:
669 case USB_SPEED_FULL:
670 speed = "12";
671 break;
672 case USB_SPEED_HIGH:
673 speed = "480";
674 break;
675 default:
676 speed = "unknown";
677 }
678
679 if (udev->manufacturer)
680 strlcpy(descr, udev->manufacturer, sizeof(descr));
681
682 if (udev->product) {
683 if (*descr)
684 strlcat(descr, " ", sizeof(descr));
685 strlcat(descr, udev->product, sizeof(descr));
686 }
687 if (*descr)
688 strlcat(descr, " ", sizeof(descr));
689
690 cx231xx_info("New device %s@ %s Mbps "
84b5dbf3
MCC
691 "(%04x:%04x, interface %d, class %d)\n",
692 descr,
693 speed,
694 le16_to_cpu(udev->descriptor.idVendor),
695 le16_to_cpu(udev->descriptor.idProduct),
696 ifnum, interface->altsetting->desc.bInterfaceNumber);
697
698 /* AV device initialization */
699 if ((dev->interface_count - 1) == dev->max_iad_interface_count) {
700 cx231xx_info(" Calling init_dev\n");
b1196126
SD
701
702 /* Create v4l2 device */
703 snprintf(dev->v4l2_dev.name, sizeof(dev->v4l2_dev.name),
704 "%s-%03d", "cx231xx", nr);
705 retval = v4l2_device_register(&udev->dev, &dev->v4l2_dev);
706 if (retval) {
707 printk(KERN_ERR "%s() v4l2_device_register failed\n",
708 __func__);
709 cx231xx_devused &= ~(1 << nr);
710 kfree(dev);
711 return -EIO;
712 }
713
84b5dbf3
MCC
714 /* allocate device struct */
715 retval = cx231xx_init_dev(&dev, udev, nr);
716 if (retval) {
717 cx231xx_devused &= ~(1 << dev->devno);
b1196126 718 v4l2_device_unregister(&dev->v4l2_dev);
84b5dbf3 719 kfree(dev);
84b5dbf3
MCC
720 return retval;
721 }
722
723 /* compute alternate max packet sizes for video */
724 uif =
725 udev->actconfig->interface[dev->current_pcb_config.
726 hs_config_info[0].interface_info.
727 video_index + 1];
728
729 dev->video_mode.end_point_addr =
730 le16_to_cpu(uif->altsetting[0].endpoint[isoc_pipe].desc.
731 bEndpointAddress);
732
733 dev->video_mode.num_alt = uif->num_altsetting;
734 cx231xx_info(": EndPoint Addr 0x%x, Alternate settings: %i\n",
735 dev->video_mode.end_point_addr,
736 dev->video_mode.num_alt);
737 dev->video_mode.alt_max_pkt_size =
738 kmalloc(32 * dev->video_mode.num_alt, GFP_KERNEL);
739
740 if (dev->video_mode.alt_max_pkt_size == NULL) {
741 cx231xx_errdev("out of memory!\n");
742 cx231xx_devused &= ~(1 << nr);
b1196126 743 v4l2_device_unregister(&dev->v4l2_dev);
84b5dbf3
MCC
744 kfree(dev);
745 return -ENOMEM;
746 }
747
748 for (i = 0; i < dev->video_mode.num_alt; i++) {
749 u16 tmp =
750 le16_to_cpu(uif->altsetting[i].endpoint[isoc_pipe].
751 desc.wMaxPacketSize);
752 dev->video_mode.alt_max_pkt_size[i] =
753 (tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + 1);
754 cx231xx_info("Alternate setting %i, max size= %i\n", i,
755 dev->video_mode.alt_max_pkt_size[i]);
756 }
757
758 /* compute alternate max packet sizes for vbi */
759 uif =
760 udev->actconfig->interface[dev->current_pcb_config.
761 hs_config_info[0].interface_info.
762 vanc_index + 1];
763
764 dev->vbi_mode.end_point_addr =
765 le16_to_cpu(uif->altsetting[0].endpoint[isoc_pipe].desc.
766 bEndpointAddress);
767
768 dev->vbi_mode.num_alt = uif->num_altsetting;
769 cx231xx_info(": EndPoint Addr 0x%x, Alternate settings: %i\n",
770 dev->vbi_mode.end_point_addr,
771 dev->vbi_mode.num_alt);
772 dev->vbi_mode.alt_max_pkt_size =
773 kmalloc(32 * dev->vbi_mode.num_alt, GFP_KERNEL);
774
775 if (dev->vbi_mode.alt_max_pkt_size == NULL) {
776 cx231xx_errdev("out of memory!\n");
777 cx231xx_devused &= ~(1 << nr);
b1196126 778 v4l2_device_unregister(&dev->v4l2_dev);
84b5dbf3
MCC
779 kfree(dev);
780 return -ENOMEM;
781 }
782
783 for (i = 0; i < dev->vbi_mode.num_alt; i++) {
784 u16 tmp =
785 le16_to_cpu(uif->altsetting[i].endpoint[isoc_pipe].
786 desc.wMaxPacketSize);
787 dev->vbi_mode.alt_max_pkt_size[i] =
788 (tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + 1);
789 cx231xx_info("Alternate setting %i, max size= %i\n", i,
790 dev->vbi_mode.alt_max_pkt_size[i]);
791 }
792
793 /* compute alternate max packet sizes for sliced CC */
794 uif =
795 udev->actconfig->interface[dev->current_pcb_config.
796 hs_config_info[0].interface_info.
797 hanc_index + 1];
798
799 dev->sliced_cc_mode.end_point_addr =
800 le16_to_cpu(uif->altsetting[0].endpoint[isoc_pipe].desc.
801 bEndpointAddress);
802
803 dev->sliced_cc_mode.num_alt = uif->num_altsetting;
804 cx231xx_info(": EndPoint Addr 0x%x, Alternate settings: %i\n",
805 dev->sliced_cc_mode.end_point_addr,
806 dev->sliced_cc_mode.num_alt);
807 dev->sliced_cc_mode.alt_max_pkt_size =
808 kmalloc(32 * dev->sliced_cc_mode.num_alt, GFP_KERNEL);
809
810 if (dev->sliced_cc_mode.alt_max_pkt_size == NULL) {
811 cx231xx_errdev("out of memory!\n");
812 cx231xx_devused &= ~(1 << nr);
b1196126 813 v4l2_device_unregister(&dev->v4l2_dev);
84b5dbf3
MCC
814 kfree(dev);
815 return -ENOMEM;
816 }
817
818 for (i = 0; i < dev->sliced_cc_mode.num_alt; i++) {
819 u16 tmp =
820 le16_to_cpu(uif->altsetting[i].endpoint[isoc_pipe].
821 desc.wMaxPacketSize);
822 dev->sliced_cc_mode.alt_max_pkt_size[i] =
823 (tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + 1);
824 cx231xx_info("Alternate setting %i, max size= %i\n", i,
825 dev->sliced_cc_mode.alt_max_pkt_size[i]);
826 }
827
828 if (dev->current_pcb_config.ts1_source != 0xff) {
829
830 /* compute alternate max packet sizes for TS1 */
831 uif =
832 udev->actconfig->interface[dev->current_pcb_config.
833 hs_config_info[0].
834 interface_info.
835 ts1_index + 1];
836
837 dev->ts1_mode.end_point_addr =
838 le16_to_cpu(uif->altsetting[0].endpoint[isoc_pipe].
839 desc.bEndpointAddress);
840
841 dev->ts1_mode.num_alt = uif->num_altsetting;
842 cx231xx_info
843 (": EndPoint Addr 0x%x, Alternate settings: %i\n",
844 dev->ts1_mode.end_point_addr,
845 dev->ts1_mode.num_alt);
846 dev->ts1_mode.alt_max_pkt_size =
847 kmalloc(32 * dev->ts1_mode.num_alt, GFP_KERNEL);
848
849 if (dev->ts1_mode.alt_max_pkt_size == NULL) {
850 cx231xx_errdev("out of memory!\n");
851 cx231xx_devused &= ~(1 << nr);
b1196126 852 v4l2_device_unregister(&dev->v4l2_dev);
84b5dbf3
MCC
853 kfree(dev);
854 return -ENOMEM;
855 }
856
857 for (i = 0; i < dev->ts1_mode.num_alt; i++) {
858 u16 tmp =
859 le16_to_cpu(uif->altsetting[i].
860 endpoint[isoc_pipe].desc.
861 wMaxPacketSize);
862 dev->ts1_mode.alt_max_pkt_size[i] =
863 (tmp & 0x07ff) * (((tmp & 0x1800) >> 11) +
864 1);
865 cx231xx_info
866 ("Alternate setting %i, max size= %i\n", i,
867 dev->ts1_mode.alt_max_pkt_size[i]);
868 }
869 }
870
871 }
e0d3bafd
SD
872
873 /* save our data pointer in this interface device */
874 usb_set_intfdata(lif, dev);
875
84b5dbf3
MCC
876 /* load other modules required */
877 if ((dev->interface_count - 1) == dev->max_iad_interface_count) {
878 cx231xx_info("Calling request modules\n");
879 request_modules(dev);
880 }
e0d3bafd 881
84b5dbf3
MCC
882 if (skip_interface) {
883 cx231xx_info("Skipping the interface\n");
884 return -ENODEV;
885 }
e0d3bafd
SD
886
887 return 0;
888}
889
890/*
891 * cx231xx_usb_disconnect()
892 * called when the device gets diconencted
893 * video device will be unregistered on v4l2_close in case it is still open
894 */
895static void cx231xx_usb_disconnect(struct usb_interface *interface)
896{
897 struct cx231xx *dev;
898
84b5dbf3 899 dev = usb_get_intfdata(interface);
e0d3bafd
SD
900 usb_set_intfdata(interface, NULL);
901
902 if (!dev)
903 return;
904
b1196126
SD
905 /* delete v4l2 device */
906 v4l2_device_unregister(&dev->v4l2_dev);
907
e0d3bafd
SD
908 /* wait until all current v4l2 io is finished then deallocate
909 resources */
910 mutex_lock(&dev->lock);
911
912 wake_up_interruptible_all(&dev->open);
913
914 if (dev->users) {
915 cx231xx_warn
916 ("device /dev/video%d is open! Deregistration and memory "
84b5dbf3 917 "deallocation are deferred on close.\n", dev->vdev->num);
e0d3bafd
SD
918
919 dev->state |= DEV_MISCONFIGURED;
920 cx231xx_uninit_isoc(dev);
921 dev->state |= DEV_DISCONNECTED;
922 wake_up_interruptible(&dev->wait_frame);
923 wake_up_interruptible(&dev->wait_stream);
924 } else {
925 dev->state |= DEV_DISCONNECTED;
926 cx231xx_release_resources(dev);
927 }
928
84b5dbf3 929 cx231xx_close_extension(dev);
e0d3bafd
SD
930
931 mutex_unlock(&dev->lock);
932
933 if (!dev->users) {
934 kfree(dev->video_mode.alt_max_pkt_size);
84b5dbf3
MCC
935 kfree(dev->vbi_mode.alt_max_pkt_size);
936 kfree(dev->sliced_cc_mode.alt_max_pkt_size);
937 kfree(dev->ts1_mode.alt_max_pkt_size);
e0d3bafd
SD
938 kfree(dev);
939 }
940}
941
942static struct usb_driver cx231xx_usb_driver = {
943 .name = "cx231xx",
944 .probe = cx231xx_usb_probe,
945 .disconnect = cx231xx_usb_disconnect,
946 .id_table = cx231xx_id_table,
947};
948
949static int __init cx231xx_module_init(void)
950{
951 int result;
952
818fdf34 953 printk(KERN_INFO DRIVER_NAME " v4l2 driver loaded.\n");
e0d3bafd
SD
954
955 /* register this driver with the USB subsystem */
956 result = usb_register(&cx231xx_usb_driver);
957 if (result)
958 cx231xx_err(DRIVER_NAME
84b5dbf3 959 " usb_register failed. Error number %d.\n", result);
e0d3bafd
SD
960
961 return result;
962}
963
964static void __exit cx231xx_module_exit(void)
965{
966 /* deregister this driver with the USB subsystem */
967 usb_deregister(&cx231xx_usb_driver);
968}
969
970module_init(cx231xx_module_init);
971module_exit(cx231xx_module_exit);