V4L/DVB (4273): Always log pvrusb2 device register / unregister events
[linux-2.6/linux-2.6-openrd.git] / drivers / media / video / pvrusb2 / pvrusb2-v4l2.c
blob59f5ef5558c80adadd0b628dbc8333c9a0a2c7ed
1 /*
3 * $Id$
5 * Copyright (C) 2005 Mike Isely <isely@pobox.com>
6 * Copyright (C) 2004 Aurelien Alleaume <slts@free.fr>
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
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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 #include <linux/kernel.h>
24 #include <linux/version.h>
25 #include "pvrusb2-context.h"
26 #include "pvrusb2-hdw.h"
27 #include "pvrusb2.h"
28 #include "pvrusb2-debug.h"
29 #include "pvrusb2-v4l2.h"
30 #include "pvrusb2-ioread.h"
31 #include <linux/videodev2.h>
32 #include <media/v4l2-common.h>
34 struct pvr2_v4l2_dev;
35 struct pvr2_v4l2_fh;
36 struct pvr2_v4l2;
38 /* V4L no longer provide the ability to set / get a private context pointer
39 (i.e. video_get_drvdata / video_set_drvdata), which means we have to
40 concoct our own context locating mechanism. Supposedly this is intended
41 to simplify driver implementation. It's not clear to me how that can
42 possibly be true. Our solution here is to maintain a lookup table of
43 our context instances, indexed by the minor device number of the V4L
44 device. See pvr2_v4l2_open() for some implications of this approach. */
45 static struct pvr2_v4l2_dev *devices[256];
46 static DEFINE_MUTEX(device_lock);
48 struct pvr2_v4l2_dev {
49 struct pvr2_v4l2 *v4lp;
50 struct video_device *vdev;
51 struct pvr2_context_stream *stream;
52 int ctxt_idx;
53 enum pvr2_config config;
56 struct pvr2_v4l2_fh {
57 struct pvr2_channel channel;
58 struct pvr2_v4l2_dev *dev_info;
59 enum v4l2_priority prio;
60 struct pvr2_ioread *rhp;
61 struct file *file;
62 struct pvr2_v4l2 *vhead;
63 struct pvr2_v4l2_fh *vnext;
64 struct pvr2_v4l2_fh *vprev;
65 wait_queue_head_t wait_data;
66 int fw_mode_flag;
69 struct pvr2_v4l2 {
70 struct pvr2_channel channel;
71 struct pvr2_v4l2_fh *vfirst;
72 struct pvr2_v4l2_fh *vlast;
74 struct v4l2_prio_state prio;
76 /* streams */
77 struct pvr2_v4l2_dev video_dev;
80 static int video_nr[PVR_NUM] = {[0 ... PVR_NUM-1] = -1};
81 module_param_array(video_nr, int, NULL, 0444);
82 MODULE_PARM_DESC(video_nr, "Offset for device's minor");
84 struct v4l2_capability pvr_capability ={
85 .driver = "pvrusb2",
86 .card = "Hauppauge WinTV pvr-usb2",
87 .bus_info = "usb",
88 .version = KERNEL_VERSION(0,8,0),
89 .capabilities = (V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_VBI_CAPTURE |
90 V4L2_CAP_TUNER | V4L2_CAP_AUDIO |
91 V4L2_CAP_READWRITE),
92 .reserved = {0,0,0,0}
95 static struct v4l2_tuner pvr_v4l2_tuners[]= {
97 .index = 0,
98 .name = "TV Tuner",
99 .type = V4L2_TUNER_ANALOG_TV,
100 .capability = (V4L2_TUNER_CAP_NORM |
101 V4L2_TUNER_CAP_STEREO |
102 V4L2_TUNER_CAP_LANG1 |
103 V4L2_TUNER_CAP_LANG2),
104 .rangelow = 0,
105 .rangehigh = 0,
106 .rxsubchans = V4L2_TUNER_SUB_STEREO,
107 .audmode = V4L2_TUNER_MODE_STEREO,
108 .signal = 0,
109 .afc = 0,
110 .reserved = {0,0,0,0}
114 struct v4l2_fmtdesc pvr_fmtdesc [] = {
116 .index = 0,
117 .type = V4L2_BUF_TYPE_VIDEO_CAPTURE,
118 .flags = V4L2_FMT_FLAG_COMPRESSED,
119 .description = "MPEG1/2",
120 // This should really be V4L2_PIX_FMT_MPEG, but xawtv
121 // breaks when I do that.
122 .pixelformat = 0, // V4L2_PIX_FMT_MPEG,
123 .reserved = { 0, 0, 0, 0 }
127 #define PVR_FORMAT_PIX 0
128 #define PVR_FORMAT_VBI 1
130 struct v4l2_format pvr_format [] = {
131 [PVR_FORMAT_PIX] = {
132 .type = V4L2_BUF_TYPE_VIDEO_CAPTURE,
133 .fmt = {
134 .pix = {
135 .width = 720,
136 .height = 576,
137 // This should really be V4L2_PIX_FMT_MPEG,
138 // but xawtv breaks when I do that.
139 .pixelformat = 0, // V4L2_PIX_FMT_MPEG,
140 .field = V4L2_FIELD_INTERLACED,
141 .bytesperline = 0, // doesn't make sense
142 // here
143 //FIXME : Don't know what to put here...
144 .sizeimage = (32*1024),
145 .colorspace = 0, // doesn't make sense here
146 .priv = 0
150 [PVR_FORMAT_VBI] = {
151 .type = V4L2_BUF_TYPE_VBI_CAPTURE,
152 .fmt = {
153 .vbi = {
154 .sampling_rate = 27000000,
155 .offset = 248,
156 .samples_per_line = 1443,
157 .sample_format = V4L2_PIX_FMT_GREY,
158 .start = { 0, 0 },
159 .count = { 0, 0 },
160 .flags = 0,
161 .reserved = { 0, 0 }
168 * pvr_ioctl()
170 * This is part of Video 4 Linux API. The procedure handles ioctl() calls.
173 static int pvr2_v4l2_do_ioctl(struct inode *inode, struct file *file,
174 unsigned int cmd, void *arg)
176 struct pvr2_v4l2_fh *fh = file->private_data;
177 struct pvr2_v4l2 *vp = fh->vhead;
178 struct pvr2_v4l2_dev *dev_info = fh->dev_info;
179 struct pvr2_hdw *hdw = fh->channel.mc_head->hdw;
180 int ret = -EINVAL;
182 if (pvrusb2_debug & PVR2_TRACE_V4LIOCTL) {
183 v4l_print_ioctl(pvr2_hdw_get_driver_name(hdw),cmd);
186 if (!pvr2_hdw_dev_ok(hdw)) {
187 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
188 "ioctl failed - bad or no context");
189 return -EFAULT;
192 /* check priority */
193 switch (cmd) {
194 case VIDIOC_S_CTRL:
195 case VIDIOC_S_STD:
196 case VIDIOC_S_INPUT:
197 case VIDIOC_S_TUNER:
198 case VIDIOC_S_FREQUENCY:
199 ret = v4l2_prio_check(&vp->prio, &fh->prio);
200 if (ret)
201 return ret;
204 switch (cmd) {
205 case VIDIOC_QUERYCAP:
207 struct v4l2_capability *cap = arg;
209 memcpy(cap, &pvr_capability, sizeof(struct v4l2_capability));
211 ret = 0;
212 break;
215 case VIDIOC_G_PRIORITY:
217 enum v4l2_priority *p = arg;
219 *p = v4l2_prio_max(&vp->prio);
220 ret = 0;
221 break;
224 case VIDIOC_S_PRIORITY:
226 enum v4l2_priority *prio = arg;
228 ret = v4l2_prio_change(&vp->prio, &fh->prio, *prio);
229 break;
232 case VIDIOC_ENUMSTD:
234 struct v4l2_standard *vs = (struct v4l2_standard *)arg;
235 int idx = vs->index;
236 ret = pvr2_hdw_get_stdenum_value(hdw,vs,idx+1);
237 break;
240 case VIDIOC_G_STD:
242 int val = 0;
243 ret = pvr2_ctrl_get_value(
244 pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_STDCUR),&val);
245 *(v4l2_std_id *)arg = val;
246 break;
249 case VIDIOC_S_STD:
251 ret = pvr2_ctrl_set_value(
252 pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_STDCUR),
253 *(v4l2_std_id *)arg);
254 break;
257 case VIDIOC_ENUMINPUT:
259 struct pvr2_ctrl *cptr;
260 struct v4l2_input *vi = (struct v4l2_input *)arg;
261 struct v4l2_input tmp;
262 unsigned int cnt;
264 cptr = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_INPUT);
266 memset(&tmp,0,sizeof(tmp));
267 tmp.index = vi->index;
268 ret = 0;
269 switch (vi->index) {
270 case PVR2_CVAL_INPUT_TV:
271 case PVR2_CVAL_INPUT_RADIO:
272 tmp.type = V4L2_INPUT_TYPE_TUNER;
273 break;
274 case PVR2_CVAL_INPUT_SVIDEO:
275 case PVR2_CVAL_INPUT_COMPOSITE:
276 tmp.type = V4L2_INPUT_TYPE_CAMERA;
277 break;
278 default:
279 ret = -EINVAL;
280 break;
282 if (ret < 0) break;
284 cnt = 0;
285 pvr2_ctrl_get_valname(cptr,vi->index,
286 tmp.name,sizeof(tmp.name)-1,&cnt);
287 tmp.name[cnt] = 0;
289 /* Don't bother with audioset, since this driver currently
290 always switches the audio whenever the video is
291 switched. */
293 /* Handling std is a tougher problem. It doesn't make
294 sense in cases where a device might be multi-standard.
295 We could just copy out the current value for the
296 standard, but it can change over time. For now just
297 leave it zero. */
299 memcpy(vi, &tmp, sizeof(tmp));
301 ret = 0;
302 break;
305 case VIDIOC_G_INPUT:
307 struct pvr2_ctrl *cptr;
308 struct v4l2_input *vi = (struct v4l2_input *)arg;
309 int val;
310 cptr = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_INPUT);
311 val = 0;
312 ret = pvr2_ctrl_get_value(cptr,&val);
313 vi->index = val;
314 break;
317 case VIDIOC_S_INPUT:
319 struct v4l2_input *vi = (struct v4l2_input *)arg;
320 ret = pvr2_ctrl_set_value(
321 pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_INPUT),
322 vi->index);
323 break;
326 case VIDIOC_ENUMAUDIO:
328 ret = -EINVAL;
329 break;
332 case VIDIOC_G_AUDIO:
334 ret = -EINVAL;
335 break;
338 case VIDIOC_S_AUDIO:
340 ret = -EINVAL;
341 break;
343 case VIDIOC_G_TUNER:
345 struct v4l2_tuner *vt = (struct v4l2_tuner *)arg;
346 unsigned int status_mask;
347 int val;
348 if (vt->index !=0) break;
350 status_mask = pvr2_hdw_get_signal_status(hdw);
352 memcpy(vt, &pvr_v4l2_tuners[vt->index],
353 sizeof(struct v4l2_tuner));
355 vt->signal = 0;
356 if (status_mask & PVR2_SIGNAL_OK) {
357 if (status_mask & PVR2_SIGNAL_STEREO) {
358 vt->rxsubchans = V4L2_TUNER_SUB_STEREO;
359 } else {
360 vt->rxsubchans = V4L2_TUNER_SUB_MONO;
362 if (status_mask & PVR2_SIGNAL_SAP) {
363 vt->rxsubchans |= (V4L2_TUNER_SUB_LANG1 |
364 V4L2_TUNER_SUB_LANG2);
366 vt->signal = 65535;
369 val = 0;
370 ret = pvr2_ctrl_get_value(
371 pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_AUDIOMODE),
372 &val);
373 vt->audmode = val;
374 break;
377 case VIDIOC_S_TUNER:
379 struct v4l2_tuner *vt=(struct v4l2_tuner *)arg;
381 if (vt->index != 0)
382 break;
384 ret = pvr2_ctrl_set_value(
385 pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_AUDIOMODE),
386 vt->audmode);
389 case VIDIOC_S_FREQUENCY:
391 const struct v4l2_frequency *vf = (struct v4l2_frequency *)arg;
392 ret = pvr2_ctrl_set_value(
393 pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_FREQUENCY),
394 vf->frequency * 62500);
395 break;
398 case VIDIOC_G_FREQUENCY:
400 struct v4l2_frequency *vf = (struct v4l2_frequency *)arg;
401 int val = 0;
402 ret = pvr2_ctrl_get_value(
403 pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_FREQUENCY),
404 &val);
405 val /= 62500;
406 vf->frequency = val;
407 break;
410 case VIDIOC_ENUM_FMT:
412 struct v4l2_fmtdesc *fd = (struct v4l2_fmtdesc *)arg;
414 /* Only one format is supported : mpeg.*/
415 if (fd->index != 0)
416 break;
418 memcpy(fd, pvr_fmtdesc, sizeof(struct v4l2_fmtdesc));
419 ret = 0;
420 break;
423 case VIDIOC_G_FMT:
425 struct v4l2_format *vf = (struct v4l2_format *)arg;
426 int val;
427 switch(vf->type) {
428 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
429 memcpy(vf, &pvr_format[PVR_FORMAT_PIX],
430 sizeof(struct v4l2_format));
431 val = 0;
432 pvr2_ctrl_get_value(
433 pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_HRES),
434 &val);
435 vf->fmt.pix.width = val;
436 val = 0;
437 pvr2_ctrl_get_value(
438 pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_VRES),
439 &val);
440 vf->fmt.pix.height = val;
441 ret = 0;
442 break;
443 case V4L2_BUF_TYPE_VBI_CAPTURE:
444 // ????? Still need to figure out to do VBI correctly
445 ret = -EINVAL;
446 break;
447 default:
448 ret = -EINVAL;
449 break;
451 break;
454 case VIDIOC_TRY_FMT:
455 case VIDIOC_S_FMT:
457 struct v4l2_format *vf = (struct v4l2_format *)arg;
459 ret = 0;
460 switch(vf->type) {
461 case V4L2_BUF_TYPE_VIDEO_CAPTURE: {
462 int h = vf->fmt.pix.height;
463 int w = vf->fmt.pix.width;
465 if (h < 200) {
466 h = 200;
467 } else if (h > 625) {
468 h = 625;
470 if (w < 320) {
471 w = 320;
472 } else if (w > 720) {
473 w = 720;
476 memcpy(vf, &pvr_format[PVR_FORMAT_PIX],
477 sizeof(struct v4l2_format));
478 vf->fmt.pix.width = w;
479 vf->fmt.pix.height = h;
481 if (cmd == VIDIOC_S_FMT) {
482 pvr2_ctrl_set_value(
483 pvr2_hdw_get_ctrl_by_id(hdw,
484 PVR2_CID_HRES),
485 vf->fmt.pix.width);
486 pvr2_ctrl_set_value(
487 pvr2_hdw_get_ctrl_by_id(hdw,
488 PVR2_CID_VRES),
489 vf->fmt.pix.height);
491 } break;
492 case V4L2_BUF_TYPE_VBI_CAPTURE:
493 // ????? Still need to figure out to do VBI correctly
494 ret = -EINVAL;
495 break;
496 default:
497 ret = -EINVAL;
498 break;
500 break;
503 case VIDIOC_STREAMON:
505 ret = pvr2_hdw_set_stream_type(hdw,dev_info->config);
506 if (ret < 0) return ret;
507 ret = pvr2_hdw_set_streaming(hdw,!0);
508 break;
511 case VIDIOC_STREAMOFF:
513 ret = pvr2_hdw_set_streaming(hdw,0);
514 break;
517 case VIDIOC_QUERYCTRL:
519 struct pvr2_ctrl *cptr;
520 struct v4l2_queryctrl *vc = (struct v4l2_queryctrl *)arg;
521 ret = 0;
522 if (vc->id & V4L2_CTRL_FLAG_NEXT_CTRL) {
523 cptr = pvr2_hdw_get_ctrl_nextv4l(
524 hdw,(vc->id & ~V4L2_CTRL_FLAG_NEXT_CTRL));
525 if (cptr) vc->id = pvr2_ctrl_get_v4lid(cptr);
526 } else {
527 cptr = pvr2_hdw_get_ctrl_v4l(hdw,vc->id);
529 if (!cptr) {
530 pvr2_trace(PVR2_TRACE_V4LIOCTL,
531 "QUERYCTRL id=0x%x not implemented here",
532 vc->id);
533 ret = -EINVAL;
534 break;
537 pvr2_trace(PVR2_TRACE_V4LIOCTL,
538 "QUERYCTRL id=0x%x mapping name=%s (%s)",
539 vc->id,pvr2_ctrl_get_name(cptr),
540 pvr2_ctrl_get_desc(cptr));
541 strlcpy(vc->name,pvr2_ctrl_get_desc(cptr),sizeof(vc->name));
542 vc->flags = pvr2_ctrl_get_v4lflags(cptr);
543 vc->default_value = pvr2_ctrl_get_def(cptr);
544 switch (pvr2_ctrl_get_type(cptr)) {
545 case pvr2_ctl_enum:
546 vc->type = V4L2_CTRL_TYPE_MENU;
547 vc->minimum = 0;
548 vc->maximum = pvr2_ctrl_get_cnt(cptr) - 1;
549 vc->step = 1;
550 break;
551 case pvr2_ctl_bool:
552 vc->type = V4L2_CTRL_TYPE_BOOLEAN;
553 vc->minimum = 0;
554 vc->maximum = 1;
555 vc->step = 1;
556 break;
557 case pvr2_ctl_int:
558 vc->type = V4L2_CTRL_TYPE_INTEGER;
559 vc->minimum = pvr2_ctrl_get_min(cptr);
560 vc->maximum = pvr2_ctrl_get_max(cptr);
561 vc->step = 1;
562 break;
563 default:
564 pvr2_trace(PVR2_TRACE_V4LIOCTL,
565 "QUERYCTRL id=0x%x name=%s not mappable",
566 vc->id,pvr2_ctrl_get_name(cptr));
567 ret = -EINVAL;
568 break;
570 break;
573 case VIDIOC_QUERYMENU:
575 struct v4l2_querymenu *vm = (struct v4l2_querymenu *)arg;
576 unsigned int cnt = 0;
577 ret = pvr2_ctrl_get_valname(pvr2_hdw_get_ctrl_v4l(hdw,vm->id),
578 vm->index,
579 vm->name,sizeof(vm->name)-1,
580 &cnt);
581 vm->name[cnt] = 0;
582 break;
585 case VIDIOC_G_CTRL:
587 struct v4l2_control *vc = (struct v4l2_control *)arg;
588 int val = 0;
589 ret = pvr2_ctrl_get_value(pvr2_hdw_get_ctrl_v4l(hdw,vc->id),
590 &val);
591 vc->value = val;
592 break;
595 case VIDIOC_S_CTRL:
597 struct v4l2_control *vc = (struct v4l2_control *)arg;
598 ret = pvr2_ctrl_set_value(pvr2_hdw_get_ctrl_v4l(hdw,vc->id),
599 vc->value);
600 break;
603 case VIDIOC_G_EXT_CTRLS:
605 struct v4l2_ext_controls *ctls =
606 (struct v4l2_ext_controls *)arg;
607 struct v4l2_ext_control *ctrl;
608 unsigned int idx;
609 int val;
610 for (idx = 0; idx < ctls->count; idx++) {
611 ctrl = ctls->controls + idx;
612 ret = pvr2_ctrl_get_value(
613 pvr2_hdw_get_ctrl_v4l(hdw,ctrl->id),&val);
614 if (ret) {
615 ctls->error_idx = idx;
616 break;
618 /* Ensure that if read as a 64 bit value, the user
619 will still get a hopefully sane value */
620 ctrl->value64 = 0;
621 ctrl->value = val;
623 break;
626 case VIDIOC_S_EXT_CTRLS:
628 struct v4l2_ext_controls *ctls =
629 (struct v4l2_ext_controls *)arg;
630 struct v4l2_ext_control *ctrl;
631 unsigned int idx;
632 for (idx = 0; idx < ctls->count; idx++) {
633 ctrl = ctls->controls + idx;
634 ret = pvr2_ctrl_set_value(
635 pvr2_hdw_get_ctrl_v4l(hdw,ctrl->id),
636 ctrl->value);
637 if (ret) {
638 ctls->error_idx = idx;
639 break;
642 break;
645 case VIDIOC_TRY_EXT_CTRLS:
647 struct v4l2_ext_controls *ctls =
648 (struct v4l2_ext_controls *)arg;
649 struct v4l2_ext_control *ctrl;
650 struct pvr2_ctrl *pctl;
651 unsigned int idx;
652 /* For the moment just validate that the requested control
653 actually exists. */
654 for (idx = 0; idx < ctls->count; idx++) {
655 ctrl = ctls->controls + idx;
656 pctl = pvr2_hdw_get_ctrl_v4l(hdw,ctrl->id);
657 if (!pctl) {
658 ret = -EINVAL;
659 ctls->error_idx = idx;
660 break;
663 break;
666 case VIDIOC_LOG_STATUS:
668 pvr2_hdw_trigger_module_log(hdw);
669 ret = 0;
670 break;
673 default :
674 ret = v4l_compat_translate_ioctl(inode,file,cmd,
675 arg,pvr2_v4l2_do_ioctl);
678 pvr2_hdw_commit_ctl(hdw);
680 if (ret < 0) {
681 if (pvrusb2_debug & PVR2_TRACE_V4LIOCTL) {
682 pvr2_trace(PVR2_TRACE_V4LIOCTL,
683 "pvr2_v4l2_do_ioctl failure, ret=%d",ret);
684 } else {
685 if (pvrusb2_debug & PVR2_TRACE_V4LIOCTL) {
686 pvr2_trace(PVR2_TRACE_V4LIOCTL,
687 "pvr2_v4l2_do_ioctl failure, ret=%d"
688 " command was:",ret);
689 v4l_print_ioctl(pvr2_hdw_get_driver_name(hdw),
690 cmd);
693 } else {
694 pvr2_trace(PVR2_TRACE_V4LIOCTL,
695 "pvr2_v4l2_do_ioctl complete, ret=%d (0x%x)",
696 ret,ret);
698 return ret;
702 static void pvr2_v4l2_dev_destroy(struct pvr2_v4l2_dev *dip)
704 printk(KERN_INFO "pvrusb2: unregistering device video%d [%s]\n",
705 dip->vdev->minor,pvr2_config_get_name(dip->config));
706 if (dip->ctxt_idx >= 0) {
707 mutex_lock(&device_lock);
708 devices[dip->ctxt_idx] = NULL;
709 dip->ctxt_idx = -1;
710 mutex_unlock(&device_lock);
712 video_unregister_device(dip->vdev);
716 static void pvr2_v4l2_destroy_no_lock(struct pvr2_v4l2 *vp)
718 pvr2_hdw_v4l_store_minor_number(vp->channel.mc_head->hdw,-1);
719 pvr2_v4l2_dev_destroy(&vp->video_dev);
721 pvr2_trace(PVR2_TRACE_STRUCT,"Destroying pvr2_v4l2 id=%p",vp);
722 pvr2_channel_done(&vp->channel);
723 kfree(vp);
727 void pvr2_v4l2_internal_check(struct pvr2_channel *chp)
729 struct pvr2_v4l2 *vp;
730 vp = container_of(chp,struct pvr2_v4l2,channel);
731 if (!vp->channel.mc_head->disconnect_flag) return;
732 if (vp->vfirst) return;
733 pvr2_v4l2_destroy_no_lock(vp);
737 int pvr2_v4l2_ioctl(struct inode *inode, struct file *file,
738 unsigned int cmd, unsigned long arg)
741 /* Temporary hack : use ivtv api until a v4l2 one is available. */
742 #define IVTV_IOC_G_CODEC 0xFFEE7703
743 #define IVTV_IOC_S_CODEC 0xFFEE7704
744 if (cmd == IVTV_IOC_G_CODEC || cmd == IVTV_IOC_S_CODEC) return 0;
745 return video_usercopy(inode, file, cmd, arg, pvr2_v4l2_do_ioctl);
749 int pvr2_v4l2_release(struct inode *inode, struct file *file)
751 struct pvr2_v4l2_fh *fhp = file->private_data;
752 struct pvr2_v4l2 *vp = fhp->vhead;
753 struct pvr2_context *mp = fhp->vhead->channel.mc_head;
755 pvr2_trace(PVR2_TRACE_OPEN_CLOSE,"pvr2_v4l2_release");
757 if (fhp->rhp) {
758 struct pvr2_stream *sp;
759 struct pvr2_hdw *hdw;
760 hdw = fhp->channel.mc_head->hdw;
761 pvr2_hdw_set_streaming(hdw,0);
762 sp = pvr2_ioread_get_stream(fhp->rhp);
763 if (sp) pvr2_stream_set_callback(sp,0,0);
764 pvr2_ioread_destroy(fhp->rhp);
765 fhp->rhp = 0;
767 v4l2_prio_close(&vp->prio, &fhp->prio);
768 file->private_data = NULL;
770 pvr2_context_enter(mp); do {
771 if (fhp->vnext) {
772 fhp->vnext->vprev = fhp->vprev;
773 } else {
774 vp->vlast = fhp->vprev;
776 if (fhp->vprev) {
777 fhp->vprev->vnext = fhp->vnext;
778 } else {
779 vp->vfirst = fhp->vnext;
781 fhp->vnext = 0;
782 fhp->vprev = 0;
783 fhp->vhead = 0;
784 pvr2_channel_done(&fhp->channel);
785 pvr2_trace(PVR2_TRACE_STRUCT,
786 "Destroying pvr_v4l2_fh id=%p",fhp);
787 kfree(fhp);
788 if (vp->channel.mc_head->disconnect_flag && !vp->vfirst) {
789 pvr2_v4l2_destroy_no_lock(vp);
791 } while (0); pvr2_context_exit(mp);
792 return 0;
796 int pvr2_v4l2_open(struct inode *inode, struct file *file)
798 struct pvr2_v4l2_dev *dip = 0; /* Our own context pointer */
799 struct pvr2_v4l2_fh *fhp;
800 struct pvr2_v4l2 *vp;
801 struct pvr2_hdw *hdw;
803 mutex_lock(&device_lock);
804 /* MCI 7-Jun-2006 Even though we're just doing what amounts to an
805 atomic read of the device mapping array here, we still need the
806 mutex. The problem is that there is a tiny race possible when
807 we register the device. We can't update the device mapping
808 array until after the device has been registered, owing to the
809 fact that we can't know the minor device number until after the
810 registration succeeds. And if another thread tries to open the
811 device in the window of time after registration but before the
812 map is updated, then it will get back an erroneous null pointer
813 and the open will result in a spurious failure. The only way to
814 prevent that is to (a) be inside the mutex here before we access
815 the array, and (b) cover the entire registration process later
816 on with this same mutex. Thus if we get inside the mutex here,
817 then we can be assured that the registration process actually
818 completed correctly. This is an unhappy complication from the
819 use of global data in a driver that lives in a preemptible
820 environment. It sure would be nice if the video device itself
821 had a means for storing and retrieving a local context pointer.
822 Oh wait. It did. But now it's gone. Silly me. */
824 unsigned int midx = iminor(file->f_dentry->d_inode);
825 if (midx < sizeof(devices)/sizeof(devices[0])) {
826 dip = devices[midx];
829 mutex_unlock(&device_lock);
831 if (!dip) return -ENODEV; /* Should be impossible but I'm paranoid */
833 vp = dip->v4lp;
834 hdw = vp->channel.hdw;
836 pvr2_trace(PVR2_TRACE_OPEN_CLOSE,"pvr2_v4l2_open");
838 if (!pvr2_hdw_dev_ok(hdw)) {
839 pvr2_trace(PVR2_TRACE_OPEN_CLOSE,
840 "pvr2_v4l2_open: hardware not ready");
841 return -EIO;
844 fhp = kmalloc(sizeof(*fhp),GFP_KERNEL);
845 if (!fhp) {
846 return -ENOMEM;
848 memset(fhp,0,sizeof(*fhp));
850 init_waitqueue_head(&fhp->wait_data);
851 fhp->dev_info = dip;
853 pvr2_context_enter(vp->channel.mc_head); do {
854 pvr2_trace(PVR2_TRACE_STRUCT,"Creating pvr_v4l2_fh id=%p",fhp);
855 pvr2_channel_init(&fhp->channel,vp->channel.mc_head);
856 fhp->vnext = 0;
857 fhp->vprev = vp->vlast;
858 if (vp->vlast) {
859 vp->vlast->vnext = fhp;
860 } else {
861 vp->vfirst = fhp;
863 vp->vlast = fhp;
864 fhp->vhead = vp;
865 } while (0); pvr2_context_exit(vp->channel.mc_head);
867 fhp->file = file;
868 file->private_data = fhp;
869 v4l2_prio_open(&vp->prio,&fhp->prio);
871 fhp->fw_mode_flag = pvr2_hdw_cpufw_get_enabled(hdw);
873 return 0;
877 static void pvr2_v4l2_notify(struct pvr2_v4l2_fh *fhp)
879 wake_up(&fhp->wait_data);
882 static int pvr2_v4l2_iosetup(struct pvr2_v4l2_fh *fh)
884 int ret;
885 struct pvr2_stream *sp;
886 struct pvr2_hdw *hdw;
887 if (fh->rhp) return 0;
889 /* First read() attempt. Try to claim the stream and start
890 it... */
891 if ((ret = pvr2_channel_claim_stream(&fh->channel,
892 fh->dev_info->stream)) != 0) {
893 /* Someone else must already have it */
894 return ret;
897 fh->rhp = pvr2_channel_create_mpeg_stream(fh->dev_info->stream);
898 if (!fh->rhp) {
899 pvr2_channel_claim_stream(&fh->channel,0);
900 return -ENOMEM;
903 hdw = fh->channel.mc_head->hdw;
904 sp = fh->dev_info->stream->stream;
905 pvr2_stream_set_callback(sp,(pvr2_stream_callback)pvr2_v4l2_notify,fh);
906 pvr2_hdw_set_stream_type(hdw,fh->dev_info->config);
907 pvr2_hdw_set_streaming(hdw,!0);
908 ret = pvr2_ioread_set_enabled(fh->rhp,!0);
910 return ret;
914 static ssize_t pvr2_v4l2_read(struct file *file,
915 char __user *buff, size_t count, loff_t *ppos)
917 struct pvr2_v4l2_fh *fh = file->private_data;
918 int ret;
920 if (fh->fw_mode_flag) {
921 struct pvr2_hdw *hdw = fh->channel.mc_head->hdw;
922 char *tbuf;
923 int c1,c2;
924 int tcnt = 0;
925 unsigned int offs = *ppos;
927 tbuf = kmalloc(PAGE_SIZE,GFP_KERNEL);
928 if (!tbuf) return -ENOMEM;
930 while (count) {
931 c1 = count;
932 if (c1 > PAGE_SIZE) c1 = PAGE_SIZE;
933 c2 = pvr2_hdw_cpufw_get(hdw,offs,tbuf,c1);
934 if (c2 < 0) {
935 tcnt = c2;
936 break;
938 if (!c2) break;
939 if (copy_to_user(buff,tbuf,c2)) {
940 tcnt = -EFAULT;
941 break;
943 offs += c2;
944 tcnt += c2;
945 buff += c2;
946 count -= c2;
947 *ppos += c2;
949 kfree(tbuf);
950 return tcnt;
953 if (!fh->rhp) {
954 ret = pvr2_v4l2_iosetup(fh);
955 if (ret) {
956 return ret;
960 for (;;) {
961 ret = pvr2_ioread_read(fh->rhp,buff,count);
962 if (ret >= 0) break;
963 if (ret != -EAGAIN) break;
964 if (file->f_flags & O_NONBLOCK) break;
965 /* Doing blocking I/O. Wait here. */
966 ret = wait_event_interruptible(
967 fh->wait_data,
968 pvr2_ioread_avail(fh->rhp) >= 0);
969 if (ret < 0) break;
972 return ret;
976 static unsigned int pvr2_v4l2_poll(struct file *file, poll_table *wait)
978 unsigned int mask = 0;
979 struct pvr2_v4l2_fh *fh = file->private_data;
980 int ret;
982 if (fh->fw_mode_flag) {
983 mask |= POLLIN | POLLRDNORM;
984 return mask;
987 if (!fh->rhp) {
988 ret = pvr2_v4l2_iosetup(fh);
989 if (ret) return POLLERR;
992 poll_wait(file,&fh->wait_data,wait);
994 if (pvr2_ioread_avail(fh->rhp) >= 0) {
995 mask |= POLLIN | POLLRDNORM;
998 return mask;
1002 static struct file_operations vdev_fops = {
1003 .owner = THIS_MODULE,
1004 .open = pvr2_v4l2_open,
1005 .release = pvr2_v4l2_release,
1006 .read = pvr2_v4l2_read,
1007 .ioctl = pvr2_v4l2_ioctl,
1008 .llseek = no_llseek,
1009 .poll = pvr2_v4l2_poll,
1013 #define VID_HARDWARE_PVRUSB2 38 /* FIXME : need a good value */
1015 static struct video_device vdev_template = {
1016 .owner = THIS_MODULE,
1017 .type = VID_TYPE_CAPTURE | VID_TYPE_TUNER,
1018 .type2 = (V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_VBI_CAPTURE
1019 | V4L2_CAP_TUNER | V4L2_CAP_AUDIO
1020 | V4L2_CAP_READWRITE),
1021 .hardware = VID_HARDWARE_PVRUSB2,
1022 .fops = &vdev_fops,
1026 static void pvr2_v4l2_dev_init(struct pvr2_v4l2_dev *dip,
1027 struct pvr2_v4l2 *vp,
1028 enum pvr2_config cfg)
1030 int mindevnum;
1031 int unit_number;
1032 int v4l_type;
1033 dip->v4lp = vp;
1034 dip->config = cfg;
1037 switch (cfg) {
1038 case pvr2_config_mpeg:
1039 v4l_type = VFL_TYPE_GRABBER;
1040 dip->stream = &vp->channel.mc_head->video_stream;
1041 break;
1042 case pvr2_config_vbi:
1043 v4l_type = VFL_TYPE_VBI;
1044 break;
1045 case pvr2_config_radio:
1046 v4l_type = VFL_TYPE_RADIO;
1047 break;
1048 default:
1049 /* Bail out (this should be impossible) */
1050 err("Failed to set up pvrusb2 v4l dev"
1051 " due to unrecognized config");
1052 return;
1055 if (!dip->stream) {
1056 err("Failed to set up pvrusb2 v4l dev"
1057 " due to missing stream instance");
1058 return;
1061 dip->vdev = video_device_alloc();
1062 if (!dip->vdev) {
1063 err("Alloc of pvrusb2 v4l video device failed");
1064 return;
1067 memcpy(dip->vdev,&vdev_template,sizeof(vdev_template));
1068 dip->vdev->release = video_device_release;
1069 mutex_lock(&device_lock);
1071 mindevnum = -1;
1072 unit_number = pvr2_hdw_get_unit_number(vp->channel.mc_head->hdw);
1073 if ((unit_number >= 0) && (unit_number < PVR_NUM)) {
1074 mindevnum = video_nr[unit_number];
1076 if ((video_register_device(dip->vdev, v4l_type, mindevnum) < 0) &&
1077 (video_register_device(dip->vdev, v4l_type, -1) < 0)) {
1078 err("Failed to register pvrusb2 v4l video device");
1079 } else {
1080 printk(KERN_INFO "pvrusb2: registered device video%d [%s]\n",
1081 dip->vdev->minor,pvr2_config_get_name(dip->config));
1084 if ((dip->vdev->minor < sizeof(devices)/sizeof(devices[0])) &&
1085 (devices[dip->vdev->minor] == NULL)) {
1086 dip->ctxt_idx = dip->vdev->minor;
1087 devices[dip->ctxt_idx] = dip;
1089 mutex_unlock(&device_lock);
1091 pvr2_hdw_v4l_store_minor_number(vp->channel.mc_head->hdw,
1092 dip->vdev->minor);
1096 struct pvr2_v4l2 *pvr2_v4l2_create(struct pvr2_context *mnp)
1098 struct pvr2_v4l2 *vp;
1100 vp = kmalloc(sizeof(*vp),GFP_KERNEL);
1101 if (!vp) return vp;
1102 memset(vp,0,sizeof(*vp));
1103 vp->video_dev.ctxt_idx = -1;
1104 pvr2_channel_init(&vp->channel,mnp);
1105 pvr2_trace(PVR2_TRACE_STRUCT,"Creating pvr2_v4l2 id=%p",vp);
1107 vp->channel.check_func = pvr2_v4l2_internal_check;
1109 /* register streams */
1110 pvr2_v4l2_dev_init(&vp->video_dev,vp,pvr2_config_mpeg);
1113 return vp;
1117 Stuff for Emacs to see, in order to encourage consistent editing style:
1118 *** Local Variables: ***
1119 *** mode: c ***
1120 *** fill-column: 75 ***
1121 *** tab-width: 8 ***
1122 *** c-basic-offset: 8 ***
1123 *** End: ***