2 * Hauppauge HD PVR USB driver - video 4 linux 2 interface
4 * Copyright (C) 2008 Janne Grunau (j@jannau.net)
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License as
8 * published by the Free Software Foundation, version 2.
12 #include <linux/kernel.h>
13 #include <linux/errno.h>
14 #include <linux/init.h>
15 #include <linux/slab.h>
16 #include <linux/module.h>
17 #include <linux/uaccess.h>
18 #include <linux/usb.h>
19 #include <linux/mutex.h>
20 #include <linux/workqueue.h>
22 #include <linux/videodev2.h>
23 #include <linux/v4l2-dv-timings.h>
24 #include <media/v4l2-dev.h>
25 #include <media/v4l2-common.h>
26 #include <media/v4l2-dv-timings.h>
27 #include <media/v4l2-ioctl.h>
28 #include <media/v4l2-event.h>
31 #define BULK_URB_TIMEOUT 90 /* 0.09 seconds */
33 #define print_buffer_status() { \
34 v4l2_dbg(MSG_BUFFER, hdpvr_debug, &dev->v4l2_dev, \
35 "%s:%d buffer stat: %d free, %d proc\n", \
37 list_size(&dev->free_buff_list), \
38 list_size(&dev->rec_buff_list)); }
40 static const struct v4l2_dv_timings hdpvr_dv_timings[] = {
41 V4L2_DV_BT_CEA_720X480I59_94,
42 V4L2_DV_BT_CEA_720X576I50,
43 V4L2_DV_BT_CEA_720X480P59_94,
44 V4L2_DV_BT_CEA_720X576P50,
45 V4L2_DV_BT_CEA_1280X720P50,
46 V4L2_DV_BT_CEA_1280X720P60,
47 V4L2_DV_BT_CEA_1920X1080I50,
48 V4L2_DV_BT_CEA_1920X1080I60,
51 /* Use 480i59 as the default timings */
52 #define HDPVR_DEF_DV_TIMINGS_IDX (0)
59 static uint list_size(struct list_head *list)
61 struct list_head *tmp;
64 list_for_each(tmp, list) {
71 /*=========================================================================*/
73 static void hdpvr_read_bulk_callback(struct urb *urb)
75 struct hdpvr_buffer *buf = (struct hdpvr_buffer *)urb->context;
76 struct hdpvr_device *dev = buf->dev;
78 /* marking buffer as received and wake waiting */
79 buf->status = BUFSTAT_READY;
80 wake_up_interruptible(&dev->wait_data);
83 /*=========================================================================*/
86 /* function expects dev->io_mutex to be hold by caller */
87 int hdpvr_cancel_queue(struct hdpvr_device *dev)
89 struct hdpvr_buffer *buf;
91 list_for_each_entry(buf, &dev->rec_buff_list, buff_list) {
92 usb_kill_urb(buf->urb);
93 buf->status = BUFSTAT_AVAILABLE;
96 list_splice_init(&dev->rec_buff_list, dev->free_buff_list.prev);
101 static int hdpvr_free_queue(struct list_head *q)
103 struct list_head *tmp;
105 struct hdpvr_buffer *buf;
108 for (p = q->next; p != q;) {
109 buf = list_entry(p, struct hdpvr_buffer, buff_list);
112 usb_free_coherent(urb->dev, urb->transfer_buffer_length,
113 urb->transfer_buffer, urb->transfer_dma);
124 /* function expects dev->io_mutex to be hold by caller */
125 int hdpvr_free_buffers(struct hdpvr_device *dev)
127 hdpvr_cancel_queue(dev);
129 hdpvr_free_queue(&dev->free_buff_list);
130 hdpvr_free_queue(&dev->rec_buff_list);
135 /* function expects dev->io_mutex to be hold by caller */
136 int hdpvr_alloc_buffers(struct hdpvr_device *dev, uint count)
139 int retval = -ENOMEM;
141 struct hdpvr_buffer *buf;
144 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev,
145 "allocating %u buffers\n", count);
147 for (i = 0; i < count; i++) {
149 buf = kzalloc(sizeof(struct hdpvr_buffer), GFP_KERNEL);
151 v4l2_err(&dev->v4l2_dev, "cannot allocate buffer\n");
156 urb = usb_alloc_urb(0, GFP_KERNEL);
161 mem = usb_alloc_coherent(dev->udev, dev->bulk_in_size, GFP_KERNEL,
164 v4l2_err(&dev->v4l2_dev,
165 "cannot allocate usb transfer buffer\n");
166 goto exit_urb_buffer;
169 usb_fill_bulk_urb(buf->urb, dev->udev,
170 usb_rcvbulkpipe(dev->udev,
171 dev->bulk_in_endpointAddr),
172 mem, dev->bulk_in_size,
173 hdpvr_read_bulk_callback, buf);
175 buf->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
176 buf->status = BUFSTAT_AVAILABLE;
177 list_add_tail(&buf->buff_list, &dev->free_buff_list);
185 hdpvr_free_buffers(dev);
189 static int hdpvr_submit_buffers(struct hdpvr_device *dev)
191 struct hdpvr_buffer *buf;
193 int ret = 0, err_count = 0;
195 mutex_lock(&dev->io_mutex);
197 while (dev->status == STATUS_STREAMING &&
198 !list_empty(&dev->free_buff_list)) {
200 buf = list_entry(dev->free_buff_list.next, struct hdpvr_buffer,
202 if (buf->status != BUFSTAT_AVAILABLE) {
203 v4l2_err(&dev->v4l2_dev,
204 "buffer not marked as available\n");
211 urb->actual_length = 0;
212 ret = usb_submit_urb(urb, GFP_KERNEL);
214 v4l2_err(&dev->v4l2_dev,
215 "usb_submit_urb in %s returned %d\n",
221 buf->status = BUFSTAT_INPROGRESS;
222 list_move_tail(&buf->buff_list, &dev->rec_buff_list);
225 print_buffer_status();
226 mutex_unlock(&dev->io_mutex);
230 static struct hdpvr_buffer *hdpvr_get_next_buffer(struct hdpvr_device *dev)
232 struct hdpvr_buffer *buf;
234 mutex_lock(&dev->io_mutex);
236 if (list_empty(&dev->rec_buff_list)) {
237 mutex_unlock(&dev->io_mutex);
241 buf = list_entry(dev->rec_buff_list.next, struct hdpvr_buffer,
243 mutex_unlock(&dev->io_mutex);
248 static void hdpvr_transmit_buffers(struct work_struct *work)
250 struct hdpvr_device *dev = container_of(work, struct hdpvr_device,
253 while (dev->status == STATUS_STREAMING) {
255 if (hdpvr_submit_buffers(dev)) {
256 v4l2_err(&dev->v4l2_dev, "couldn't submit buffers\n");
259 if (wait_event_interruptible(dev->wait_buffer,
260 !list_empty(&dev->free_buff_list) ||
261 dev->status != STATUS_STREAMING))
265 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev,
266 "transmit worker exited\n");
269 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev,
270 "transmit buffers errored\n");
271 dev->status = STATUS_ERROR;
274 /* function expects dev->io_mutex to be hold by caller */
275 static int hdpvr_start_streaming(struct hdpvr_device *dev)
278 struct hdpvr_video_info vidinf;
280 if (dev->status == STATUS_STREAMING)
282 if (dev->status != STATUS_IDLE)
285 ret = get_video_info(dev, &vidinf);
291 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev,
292 "no video signal at input %d\n", dev->options.video_input);
296 v4l2_dbg(MSG_BUFFER, hdpvr_debug, &dev->v4l2_dev,
297 "video signal: %dx%d@%dhz\n", vidinf.width,
298 vidinf.height, vidinf.fps);
300 /* start streaming 2 request */
301 ret = usb_control_msg(dev->udev,
302 usb_sndctrlpipe(dev->udev, 0),
303 0xb8, 0x38, 0x1, 0, NULL, 0, 8000);
304 v4l2_dbg(MSG_BUFFER, hdpvr_debug, &dev->v4l2_dev,
305 "encoder start control request returned %d\n", ret);
309 ret = hdpvr_config_call(dev, CTRL_START_STREAMING_VALUE, 0x00);
313 dev->status = STATUS_STREAMING;
315 INIT_WORK(&dev->worker, hdpvr_transmit_buffers);
316 schedule_work(&dev->worker);
318 v4l2_dbg(MSG_BUFFER, hdpvr_debug, &dev->v4l2_dev,
319 "streaming started\n");
325 /* function expects dev->io_mutex to be hold by caller */
326 static int hdpvr_stop_streaming(struct hdpvr_device *dev)
332 if (dev->status == STATUS_IDLE)
334 else if (dev->status != STATUS_STREAMING)
337 buf = kmalloc(dev->bulk_in_size, GFP_KERNEL);
339 v4l2_err(&dev->v4l2_dev, "failed to allocate temporary buffer for emptying the internal device buffer. Next capture start will be slow\n");
341 dev->status = STATUS_SHUTTING_DOWN;
342 hdpvr_config_call(dev, CTRL_STOP_STREAMING_VALUE, 0x00);
343 mutex_unlock(&dev->io_mutex);
345 wake_up_interruptible(&dev->wait_buffer);
348 flush_work(&dev->worker);
350 mutex_lock(&dev->io_mutex);
351 /* kill the still outstanding urbs */
352 hdpvr_cancel_queue(dev);
354 /* emptying the device buffer beforeshutting it down */
355 while (buf && ++c < 500 &&
356 !usb_bulk_msg(dev->udev,
357 usb_rcvbulkpipe(dev->udev,
358 dev->bulk_in_endpointAddr),
359 buf, dev->bulk_in_size, &actual_length,
361 v4l2_dbg(MSG_BUFFER, hdpvr_debug, &dev->v4l2_dev,
362 "%2d: got %d bytes\n", c, actual_length);
365 v4l2_dbg(MSG_BUFFER, hdpvr_debug, &dev->v4l2_dev,
366 "used %d urbs to empty device buffers\n", c-1);
369 dev->status = STATUS_IDLE;
375 /*=======================================================================*/
377 * video 4 linux 2 file operations
380 static int hdpvr_open(struct file *file)
382 struct hdpvr_fh *fh = kzalloc(sizeof(*fh), GFP_KERNEL);
386 fh->legacy_mode = true;
387 v4l2_fh_init(&fh->fh, video_devdata(file));
388 v4l2_fh_add(&fh->fh);
389 file->private_data = fh;
393 static int hdpvr_release(struct file *file)
395 struct hdpvr_device *dev = video_drvdata(file);
397 mutex_lock(&dev->io_mutex);
398 if (file->private_data == dev->owner) {
399 hdpvr_stop_streaming(dev);
402 mutex_unlock(&dev->io_mutex);
404 return v4l2_fh_release(file);
409 * will allocate buffers when called for the first time
411 static ssize_t hdpvr_read(struct file *file, char __user *buffer, size_t count,
414 struct hdpvr_device *dev = video_drvdata(file);
415 struct hdpvr_buffer *buf = NULL;
417 unsigned int ret = 0;
423 mutex_lock(&dev->io_mutex);
424 if (dev->status == STATUS_IDLE) {
425 if (hdpvr_start_streaming(dev)) {
426 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev,
427 "start_streaming failed\n");
430 dev->status = STATUS_IDLE;
431 mutex_unlock(&dev->io_mutex);
434 dev->owner = file->private_data;
435 print_buffer_status();
437 mutex_unlock(&dev->io_mutex);
439 /* wait for the first buffer */
440 if (!(file->f_flags & O_NONBLOCK)) {
441 if (wait_event_interruptible(dev->wait_data,
442 !list_empty_careful(&dev->rec_buff_list)))
446 buf = hdpvr_get_next_buffer(dev);
448 while (count > 0 && buf) {
450 if (buf->status != BUFSTAT_READY &&
451 dev->status != STATUS_DISCONNECTED) {
453 /* return nonblocking */
454 if (file->f_flags & O_NONBLOCK) {
460 err = wait_event_interruptible_timeout(dev->wait_data,
461 buf->status == BUFSTAT_READY,
462 msecs_to_jiffies(1000));
468 v4l2_info(&dev->v4l2_dev,
469 "timeout: restart streaming\n");
470 mutex_lock(&dev->io_mutex);
471 hdpvr_stop_streaming(dev);
472 mutex_unlock(&dev->io_mutex);
474 * The FW needs about 4 seconds after streaming
475 * stopped before it is ready to restart
479 err = hdpvr_start_streaming(dev);
487 if (buf->status != BUFSTAT_READY)
490 /* set remaining bytes to copy */
492 rem = urb->actual_length - buf->pos;
493 cnt = rem > count ? count : rem;
495 if (copy_to_user(buffer, urb->transfer_buffer + buf->pos,
497 v4l2_err(&dev->v4l2_dev, "read: copy_to_user failed\n");
508 /* finished, take next buffer */
509 if (buf->pos == urb->actual_length) {
510 mutex_lock(&dev->io_mutex);
512 buf->status = BUFSTAT_AVAILABLE;
514 list_move_tail(&buf->buff_list, &dev->free_buff_list);
516 print_buffer_status();
518 mutex_unlock(&dev->io_mutex);
520 wake_up_interruptible(&dev->wait_buffer);
522 buf = hdpvr_get_next_buffer(dev);
531 static __poll_t hdpvr_poll(struct file *filp, poll_table *wait)
533 __poll_t req_events = poll_requested_events(wait);
534 struct hdpvr_buffer *buf = NULL;
535 struct hdpvr_device *dev = video_drvdata(filp);
536 __poll_t mask = v4l2_ctrl_poll(filp, wait);
538 if (!(req_events & (EPOLLIN | EPOLLRDNORM)))
541 mutex_lock(&dev->io_mutex);
543 if (dev->status == STATUS_IDLE) {
544 if (hdpvr_start_streaming(dev)) {
545 v4l2_dbg(MSG_BUFFER, hdpvr_debug, &dev->v4l2_dev,
546 "start_streaming failed\n");
547 dev->status = STATUS_IDLE;
549 dev->owner = filp->private_data;
552 print_buffer_status();
554 mutex_unlock(&dev->io_mutex);
556 buf = hdpvr_get_next_buffer(dev);
557 /* only wait if no data is available */
558 if (!buf || buf->status != BUFSTAT_READY) {
559 poll_wait(filp, &dev->wait_data, wait);
560 buf = hdpvr_get_next_buffer(dev);
562 if (buf && buf->status == BUFSTAT_READY)
563 mask |= EPOLLIN | EPOLLRDNORM;
569 static const struct v4l2_file_operations hdpvr_fops = {
570 .owner = THIS_MODULE,
572 .release = hdpvr_release,
575 .unlocked_ioctl = video_ioctl2,
578 /*=======================================================================*/
580 * V4L2 ioctl handling
583 static int vidioc_querycap(struct file *file, void *priv,
584 struct v4l2_capability *cap)
586 struct hdpvr_device *dev = video_drvdata(file);
588 strcpy(cap->driver, "hdpvr");
589 strcpy(cap->card, "Hauppauge HD PVR");
590 usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info));
591 cap->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_AUDIO |
593 cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS;
597 static int vidioc_s_std(struct file *file, void *_fh,
600 struct hdpvr_device *dev = video_drvdata(file);
601 struct hdpvr_fh *fh = _fh;
604 if (!fh->legacy_mode && dev->options.video_input == HDPVR_COMPONENT)
606 if (dev->status != STATUS_IDLE)
608 if (std & V4L2_STD_525_60)
612 dev->height = std_type ? 576 : 480;
614 return hdpvr_config_call(dev, CTRL_VIDEO_STD_TYPE, std_type);
617 static int vidioc_g_std(struct file *file, void *_fh,
620 struct hdpvr_device *dev = video_drvdata(file);
621 struct hdpvr_fh *fh = _fh;
623 if (!fh->legacy_mode && dev->options.video_input == HDPVR_COMPONENT)
629 static int vidioc_querystd(struct file *file, void *_fh, v4l2_std_id *a)
631 struct hdpvr_device *dev = video_drvdata(file);
632 struct hdpvr_video_info vid_info;
633 struct hdpvr_fh *fh = _fh;
636 *a = V4L2_STD_UNKNOWN;
637 if (dev->options.video_input == HDPVR_COMPONENT)
638 return fh->legacy_mode ? 0 : -ENODATA;
639 ret = get_video_info(dev, &vid_info);
640 if (vid_info.valid && vid_info.width == 720 &&
641 (vid_info.height == 480 || vid_info.height == 576)) {
642 *a = (vid_info.height == 480) ?
643 V4L2_STD_525_60 : V4L2_STD_625_50;
648 static int vidioc_s_dv_timings(struct file *file, void *_fh,
649 struct v4l2_dv_timings *timings)
651 struct hdpvr_device *dev = video_drvdata(file);
652 struct hdpvr_fh *fh = _fh;
655 fh->legacy_mode = false;
656 if (dev->options.video_input)
658 if (dev->status != STATUS_IDLE)
660 for (i = 0; i < ARRAY_SIZE(hdpvr_dv_timings); i++)
661 if (v4l2_match_dv_timings(timings, hdpvr_dv_timings + i, 0, false))
663 if (i == ARRAY_SIZE(hdpvr_dv_timings))
665 dev->cur_dv_timings = hdpvr_dv_timings[i];
666 dev->width = hdpvr_dv_timings[i].bt.width;
667 dev->height = hdpvr_dv_timings[i].bt.height;
671 static int vidioc_g_dv_timings(struct file *file, void *_fh,
672 struct v4l2_dv_timings *timings)
674 struct hdpvr_device *dev = video_drvdata(file);
675 struct hdpvr_fh *fh = _fh;
677 fh->legacy_mode = false;
678 if (dev->options.video_input)
680 *timings = dev->cur_dv_timings;
684 static int vidioc_query_dv_timings(struct file *file, void *_fh,
685 struct v4l2_dv_timings *timings)
687 struct hdpvr_device *dev = video_drvdata(file);
688 struct hdpvr_fh *fh = _fh;
689 struct hdpvr_video_info vid_info;
694 fh->legacy_mode = false;
695 if (dev->options.video_input)
697 ret = get_video_info(dev, &vid_info);
702 interlaced = vid_info.fps <= 30;
703 for (i = 0; i < ARRAY_SIZE(hdpvr_dv_timings); i++) {
704 const struct v4l2_bt_timings *bt = &hdpvr_dv_timings[i].bt;
709 hsize = V4L2_DV_BT_FRAME_WIDTH(bt);
710 vsize = V4L2_DV_BT_FRAME_HEIGHT(bt);
711 fps = (unsigned)bt->pixelclock / (hsize * vsize);
712 if (bt->width != vid_info.width ||
713 bt->height != vid_info.height ||
714 bt->interlaced != interlaced ||
715 (fps != vid_info.fps && fps + 1 != vid_info.fps))
717 *timings = hdpvr_dv_timings[i];
720 if (i == ARRAY_SIZE(hdpvr_dv_timings))
726 static int vidioc_enum_dv_timings(struct file *file, void *_fh,
727 struct v4l2_enum_dv_timings *timings)
729 struct hdpvr_device *dev = video_drvdata(file);
730 struct hdpvr_fh *fh = _fh;
732 fh->legacy_mode = false;
733 memset(timings->reserved, 0, sizeof(timings->reserved));
734 if (dev->options.video_input)
736 if (timings->index >= ARRAY_SIZE(hdpvr_dv_timings))
738 timings->timings = hdpvr_dv_timings[timings->index];
742 static int vidioc_dv_timings_cap(struct file *file, void *_fh,
743 struct v4l2_dv_timings_cap *cap)
745 struct hdpvr_device *dev = video_drvdata(file);
746 struct hdpvr_fh *fh = _fh;
748 fh->legacy_mode = false;
749 if (dev->options.video_input)
751 cap->type = V4L2_DV_BT_656_1120;
752 cap->bt.min_width = 720;
753 cap->bt.max_width = 1920;
754 cap->bt.min_height = 480;
755 cap->bt.max_height = 1080;
756 cap->bt.min_pixelclock = 27000000;
757 cap->bt.max_pixelclock = 74250000;
758 cap->bt.standards = V4L2_DV_BT_STD_CEA861;
759 cap->bt.capabilities = V4L2_DV_BT_CAP_INTERLACED | V4L2_DV_BT_CAP_PROGRESSIVE;
763 static const char *iname[] = {
764 [HDPVR_COMPONENT] = "Component",
765 [HDPVR_SVIDEO] = "S-Video",
766 [HDPVR_COMPOSITE] = "Composite",
769 static int vidioc_enum_input(struct file *file, void *_fh, struct v4l2_input *i)
774 if (n >= HDPVR_VIDEO_INPUTS)
777 i->type = V4L2_INPUT_TYPE_CAMERA;
779 strncpy(i->name, iname[n], sizeof(i->name) - 1);
780 i->name[sizeof(i->name) - 1] = '\0';
782 i->audioset = 1<<HDPVR_RCA_FRONT | 1<<HDPVR_RCA_BACK | 1<<HDPVR_SPDIF;
784 i->capabilities = n ? V4L2_IN_CAP_STD : V4L2_IN_CAP_DV_TIMINGS;
785 i->std = n ? V4L2_STD_ALL : 0;
790 static int vidioc_s_input(struct file *file, void *_fh,
793 struct hdpvr_device *dev = video_drvdata(file);
796 if (index >= HDPVR_VIDEO_INPUTS)
799 if (dev->status != STATUS_IDLE)
802 retval = hdpvr_config_call(dev, CTRL_VIDEO_INPUT_VALUE, index+1);
804 dev->options.video_input = index;
806 * Unfortunately gstreamer calls ENUMSTD and bails out if it
807 * won't find any formats, even though component input is
808 * selected. This means that we have to leave tvnorms at
809 * V4L2_STD_ALL. We cannot use the 'legacy' trick since
810 * tvnorms is set at the device node level and not at the
813 * Comment this out for now, but if the legacy mode can be
814 * removed in the future, then this code should be enabled
816 dev->video_dev.tvnorms =
817 (index != HDPVR_COMPONENT) ? V4L2_STD_ALL : 0;
824 static int vidioc_g_input(struct file *file, void *private_data,
827 struct hdpvr_device *dev = video_drvdata(file);
829 *index = dev->options.video_input;
834 static const char *audio_iname[] = {
835 [HDPVR_RCA_FRONT] = "RCA front",
836 [HDPVR_RCA_BACK] = "RCA back",
837 [HDPVR_SPDIF] = "SPDIF",
840 static int vidioc_enumaudio(struct file *file, void *priv,
841 struct v4l2_audio *audio)
846 if (n >= HDPVR_AUDIO_INPUTS)
849 audio->capability = V4L2_AUDCAP_STEREO;
851 strncpy(audio->name, audio_iname[n], sizeof(audio->name) - 1);
852 audio->name[sizeof(audio->name) - 1] = '\0';
857 static int vidioc_s_audio(struct file *file, void *private_data,
858 const struct v4l2_audio *audio)
860 struct hdpvr_device *dev = video_drvdata(file);
863 if (audio->index >= HDPVR_AUDIO_INPUTS)
866 if (dev->status != STATUS_IDLE)
869 retval = hdpvr_set_audio(dev, audio->index+1, dev->options.audio_codec);
871 dev->options.audio_input = audio->index;
876 static int vidioc_g_audio(struct file *file, void *private_data,
877 struct v4l2_audio *audio)
879 struct hdpvr_device *dev = video_drvdata(file);
881 audio->index = dev->options.audio_input;
882 audio->capability = V4L2_AUDCAP_STEREO;
883 strlcpy(audio->name, audio_iname[audio->index], sizeof(audio->name));
884 audio->name[sizeof(audio->name) - 1] = '\0';
888 static int hdpvr_try_ctrl(struct v4l2_ctrl *ctrl)
890 struct hdpvr_device *dev =
891 container_of(ctrl->handler, struct hdpvr_device, hdl);
894 case V4L2_CID_MPEG_VIDEO_BITRATE_MODE:
895 if (ctrl->val == V4L2_MPEG_VIDEO_BITRATE_MODE_VBR &&
896 dev->video_bitrate->val >= dev->video_bitrate_peak->val)
897 dev->video_bitrate_peak->val =
898 dev->video_bitrate->val + 100000;
904 static int hdpvr_s_ctrl(struct v4l2_ctrl *ctrl)
906 struct hdpvr_device *dev =
907 container_of(ctrl->handler, struct hdpvr_device, hdl);
908 struct hdpvr_options *opt = &dev->options;
912 case V4L2_CID_BRIGHTNESS:
913 ret = hdpvr_config_call(dev, CTRL_BRIGHTNESS, ctrl->val);
916 dev->options.brightness = ctrl->val;
918 case V4L2_CID_CONTRAST:
919 ret = hdpvr_config_call(dev, CTRL_CONTRAST, ctrl->val);
922 dev->options.contrast = ctrl->val;
924 case V4L2_CID_SATURATION:
925 ret = hdpvr_config_call(dev, CTRL_SATURATION, ctrl->val);
928 dev->options.saturation = ctrl->val;
931 ret = hdpvr_config_call(dev, CTRL_HUE, ctrl->val);
934 dev->options.hue = ctrl->val;
936 case V4L2_CID_SHARPNESS:
937 ret = hdpvr_config_call(dev, CTRL_SHARPNESS, ctrl->val);
940 dev->options.sharpness = ctrl->val;
942 case V4L2_CID_MPEG_AUDIO_ENCODING:
943 if (dev->flags & HDPVR_FLAG_AC3_CAP) {
944 opt->audio_codec = ctrl->val;
945 return hdpvr_set_audio(dev, opt->audio_input + 1,
949 case V4L2_CID_MPEG_VIDEO_ENCODING:
951 /* case V4L2_CID_MPEG_VIDEO_B_FRAMES: */
952 /* if (ctrl->value == 0 && !(opt->gop_mode & 0x2)) { */
953 /* opt->gop_mode |= 0x2; */
954 /* hdpvr_config_call(dev, CTRL_GOP_MODE_VALUE, */
955 /* opt->gop_mode); */
957 /* if (ctrl->value == 128 && opt->gop_mode & 0x2) { */
958 /* opt->gop_mode &= ~0x2; */
959 /* hdpvr_config_call(dev, CTRL_GOP_MODE_VALUE, */
960 /* opt->gop_mode); */
963 case V4L2_CID_MPEG_VIDEO_BITRATE_MODE: {
964 uint peak_bitrate = dev->video_bitrate_peak->val / 100000;
965 uint bitrate = dev->video_bitrate->val / 100000;
968 if (ctrl->val == V4L2_MPEG_VIDEO_BITRATE_MODE_CBR)
969 opt->bitrate_mode = HDPVR_CONSTANT;
971 opt->bitrate_mode = HDPVR_VARIABLE_AVERAGE;
972 hdpvr_config_call(dev, CTRL_BITRATE_MODE_VALUE,
974 v4l2_ctrl_activate(dev->video_bitrate_peak,
975 ctrl->val != V4L2_MPEG_VIDEO_BITRATE_MODE_CBR);
978 if (dev->video_bitrate_peak->is_new ||
979 dev->video_bitrate->is_new) {
980 opt->bitrate = bitrate;
981 opt->peak_bitrate = peak_bitrate;
982 hdpvr_set_bitrate(dev);
986 case V4L2_CID_MPEG_STREAM_TYPE:
994 static int vidioc_enum_fmt_vid_cap(struct file *file, void *private_data,
995 struct v4l2_fmtdesc *f)
1000 f->flags = V4L2_FMT_FLAG_COMPRESSED;
1001 strncpy(f->description, "MPEG2-TS with AVC/AAC streams", 32);
1002 f->pixelformat = V4L2_PIX_FMT_MPEG;
1007 static int vidioc_g_fmt_vid_cap(struct file *file, void *_fh,
1008 struct v4l2_format *f)
1010 struct hdpvr_device *dev = video_drvdata(file);
1011 struct hdpvr_fh *fh = _fh;
1015 * The original driver would always returns the current detected
1016 * resolution as the format (and EFAULT if it couldn't be detected).
1017 * With the introduction of VIDIOC_QUERY_DV_TIMINGS there is now a
1018 * better way of doing this, but to stay compatible with existing
1019 * applications we assume legacy mode every time an application opens
1020 * the device. Only if one of the new DV_TIMINGS ioctls is called
1021 * will the filehandle go into 'normal' mode where g_fmt returns the
1024 if (fh->legacy_mode) {
1025 struct hdpvr_video_info vid_info;
1027 ret = get_video_info(dev, &vid_info);
1030 if (!vid_info.valid)
1032 f->fmt.pix.width = vid_info.width;
1033 f->fmt.pix.height = vid_info.height;
1035 f->fmt.pix.width = dev->width;
1036 f->fmt.pix.height = dev->height;
1038 f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG;
1039 f->fmt.pix.sizeimage = dev->bulk_in_size;
1040 f->fmt.pix.bytesperline = 0;
1041 if (f->fmt.pix.width == 720) {
1043 f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
1044 f->fmt.pix.field = V4L2_FIELD_INTERLACED;
1047 f->fmt.pix.colorspace = V4L2_COLORSPACE_REC709;
1048 f->fmt.pix.field = V4L2_FIELD_NONE;
1053 static int vidioc_encoder_cmd(struct file *filp, void *priv,
1054 struct v4l2_encoder_cmd *a)
1056 struct hdpvr_device *dev = video_drvdata(filp);
1059 mutex_lock(&dev->io_mutex);
1063 case V4L2_ENC_CMD_START:
1064 if (dev->owner && filp->private_data != dev->owner) {
1068 if (dev->status == STATUS_STREAMING)
1070 res = hdpvr_start_streaming(dev);
1072 dev->owner = filp->private_data;
1074 dev->status = STATUS_IDLE;
1076 case V4L2_ENC_CMD_STOP:
1077 if (dev->owner && filp->private_data != dev->owner) {
1081 if (dev->status == STATUS_IDLE)
1083 res = hdpvr_stop_streaming(dev);
1088 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev,
1089 "Unsupported encoder cmd %d\n", a->cmd);
1094 mutex_unlock(&dev->io_mutex);
1098 static int vidioc_try_encoder_cmd(struct file *filp, void *priv,
1099 struct v4l2_encoder_cmd *a)
1103 case V4L2_ENC_CMD_START:
1104 case V4L2_ENC_CMD_STOP:
1111 static const struct v4l2_ioctl_ops hdpvr_ioctl_ops = {
1112 .vidioc_querycap = vidioc_querycap,
1113 .vidioc_s_std = vidioc_s_std,
1114 .vidioc_g_std = vidioc_g_std,
1115 .vidioc_querystd = vidioc_querystd,
1116 .vidioc_s_dv_timings = vidioc_s_dv_timings,
1117 .vidioc_g_dv_timings = vidioc_g_dv_timings,
1118 .vidioc_query_dv_timings= vidioc_query_dv_timings,
1119 .vidioc_enum_dv_timings = vidioc_enum_dv_timings,
1120 .vidioc_dv_timings_cap = vidioc_dv_timings_cap,
1121 .vidioc_enum_input = vidioc_enum_input,
1122 .vidioc_g_input = vidioc_g_input,
1123 .vidioc_s_input = vidioc_s_input,
1124 .vidioc_enumaudio = vidioc_enumaudio,
1125 .vidioc_g_audio = vidioc_g_audio,
1126 .vidioc_s_audio = vidioc_s_audio,
1127 .vidioc_enum_fmt_vid_cap= vidioc_enum_fmt_vid_cap,
1128 .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap,
1129 .vidioc_s_fmt_vid_cap = vidioc_g_fmt_vid_cap,
1130 .vidioc_try_fmt_vid_cap = vidioc_g_fmt_vid_cap,
1131 .vidioc_encoder_cmd = vidioc_encoder_cmd,
1132 .vidioc_try_encoder_cmd = vidioc_try_encoder_cmd,
1133 .vidioc_log_status = v4l2_ctrl_log_status,
1134 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
1135 .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
1138 static void hdpvr_device_release(struct video_device *vdev)
1140 struct hdpvr_device *dev = video_get_drvdata(vdev);
1143 flush_work(&dev->worker);
1145 v4l2_device_unregister(&dev->v4l2_dev);
1146 v4l2_ctrl_handler_free(&dev->hdl);
1148 /* deregister I2C adapter */
1149 #if IS_ENABLED(CONFIG_I2C)
1150 mutex_lock(&dev->i2c_mutex);
1151 i2c_del_adapter(&dev->i2c_adapter);
1152 mutex_unlock(&dev->i2c_mutex);
1153 #endif /* CONFIG_I2C */
1155 kfree(dev->usbc_buf);
1159 static const struct video_device hdpvr_video_template = {
1160 .fops = &hdpvr_fops,
1161 .release = hdpvr_device_release,
1162 .ioctl_ops = &hdpvr_ioctl_ops,
1163 .tvnorms = V4L2_STD_ALL,
1166 static const struct v4l2_ctrl_ops hdpvr_ctrl_ops = {
1167 .try_ctrl = hdpvr_try_ctrl,
1168 .s_ctrl = hdpvr_s_ctrl,
1171 int hdpvr_register_videodev(struct hdpvr_device *dev, struct device *parent,
1174 struct v4l2_ctrl_handler *hdl = &dev->hdl;
1175 bool ac3 = dev->flags & HDPVR_FLAG_AC3_CAP;
1178 dev->cur_std = V4L2_STD_525_60;
1181 dev->cur_dv_timings = hdpvr_dv_timings[HDPVR_DEF_DV_TIMINGS_IDX];
1182 v4l2_ctrl_handler_init(hdl, 11);
1183 if (dev->fw_ver > 0x15) {
1184 v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1185 V4L2_CID_BRIGHTNESS, 0x0, 0xff, 1, 0x80);
1186 v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1187 V4L2_CID_CONTRAST, 0x0, 0xff, 1, 0x40);
1188 v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1189 V4L2_CID_SATURATION, 0x0, 0xff, 1, 0x40);
1190 v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1191 V4L2_CID_HUE, 0x0, 0x1e, 1, 0xf);
1192 v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1193 V4L2_CID_SHARPNESS, 0x0, 0xff, 1, 0x80);
1195 v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1196 V4L2_CID_BRIGHTNESS, 0x0, 0xff, 1, 0x86);
1197 v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1198 V4L2_CID_CONTRAST, 0x0, 0xff, 1, 0x80);
1199 v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1200 V4L2_CID_SATURATION, 0x0, 0xff, 1, 0x80);
1201 v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1202 V4L2_CID_HUE, 0x0, 0xff, 1, 0x80);
1203 v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1204 V4L2_CID_SHARPNESS, 0x0, 0xff, 1, 0x80);
1207 v4l2_ctrl_new_std_menu(hdl, &hdpvr_ctrl_ops,
1208 V4L2_CID_MPEG_STREAM_TYPE,
1209 V4L2_MPEG_STREAM_TYPE_MPEG2_TS,
1210 0x1, V4L2_MPEG_STREAM_TYPE_MPEG2_TS);
1211 v4l2_ctrl_new_std_menu(hdl, &hdpvr_ctrl_ops,
1212 V4L2_CID_MPEG_AUDIO_ENCODING,
1213 ac3 ? V4L2_MPEG_AUDIO_ENCODING_AC3 : V4L2_MPEG_AUDIO_ENCODING_AAC,
1214 0x7, ac3 ? dev->options.audio_codec : V4L2_MPEG_AUDIO_ENCODING_AAC);
1215 v4l2_ctrl_new_std_menu(hdl, &hdpvr_ctrl_ops,
1216 V4L2_CID_MPEG_VIDEO_ENCODING,
1217 V4L2_MPEG_VIDEO_ENCODING_MPEG_4_AVC, 0x3,
1218 V4L2_MPEG_VIDEO_ENCODING_MPEG_4_AVC);
1220 dev->video_mode = v4l2_ctrl_new_std_menu(hdl, &hdpvr_ctrl_ops,
1221 V4L2_CID_MPEG_VIDEO_BITRATE_MODE,
1222 V4L2_MPEG_VIDEO_BITRATE_MODE_CBR, 0,
1223 V4L2_MPEG_VIDEO_BITRATE_MODE_CBR);
1225 dev->video_bitrate = v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1226 V4L2_CID_MPEG_VIDEO_BITRATE,
1227 1000000, 13500000, 100000, 6500000);
1228 dev->video_bitrate_peak = v4l2_ctrl_new_std(hdl, &hdpvr_ctrl_ops,
1229 V4L2_CID_MPEG_VIDEO_BITRATE_PEAK,
1230 1100000, 20200000, 100000, 9000000);
1231 dev->v4l2_dev.ctrl_handler = hdl;
1234 v4l2_err(&dev->v4l2_dev, "Could not register controls\n");
1237 v4l2_ctrl_cluster(3, &dev->video_mode);
1238 res = v4l2_ctrl_handler_setup(hdl);
1240 v4l2_err(&dev->v4l2_dev, "Could not setup controls\n");
1244 /* setup and register video device */
1245 dev->video_dev = hdpvr_video_template;
1246 strcpy(dev->video_dev.name, "Hauppauge HD PVR");
1247 dev->video_dev.v4l2_dev = &dev->v4l2_dev;
1248 video_set_drvdata(&dev->video_dev, dev);
1250 res = video_register_device(&dev->video_dev, VFL_TYPE_GRABBER, devnum);
1252 v4l2_err(&dev->v4l2_dev, "video_device registration failed\n");
1258 v4l2_ctrl_handler_free(hdl);