2 * Copyright (C) 2010-2013 Bluecherry, LLC <http://www.bluecherrydvr.com>
5 * Ben Collins <bcollins@ubuntu.com>
8 * John Brooks <john.brooks@bluecherry.net>
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
25 #include <linux/kernel.h>
26 #include <linux/module.h>
27 #include <linux/kthread.h>
28 #include <linux/freezer.h>
30 #include <media/v4l2-ioctl.h>
31 #include <media/v4l2-common.h>
32 #include <media/v4l2-event.h>
33 #include <media/videobuf2-dma-contig.h>
36 #include "solo6x10-tw28.h"
38 /* Image size is two fields, SOLO_HW_BPL is one horizontal line in hardware */
39 #define SOLO_HW_BPL 2048
40 #define solo_vlines(__solo) (__solo->video_vsize * 2)
41 #define solo_image_size(__solo) (solo_bytesperline(__solo) * \
43 #define solo_bytesperline(__solo) (__solo->video_hsize * 2)
45 #define MIN_VID_BUFFERS 2
47 static inline void erase_on(struct solo_dev
*solo_dev
)
49 solo_reg_write(solo_dev
, SOLO_VO_DISP_ERASE
, SOLO_VO_DISP_ERASE_ON
);
50 solo_dev
->erasing
= 1;
51 solo_dev
->frame_blank
= 0;
54 static inline int erase_off(struct solo_dev
*solo_dev
)
56 if (!solo_dev
->erasing
)
59 /* First time around, assert erase off */
60 if (!solo_dev
->frame_blank
)
61 solo_reg_write(solo_dev
, SOLO_VO_DISP_ERASE
, 0);
62 /* Keep the erasing flag on for 8 frames minimum */
63 if (solo_dev
->frame_blank
++ >= 8)
64 solo_dev
->erasing
= 0;
69 void solo_video_in_isr(struct solo_dev
*solo_dev
)
71 wake_up_interruptible_all(&solo_dev
->disp_thread_wait
);
74 static void solo_win_setup(struct solo_dev
*solo_dev
, u8 ch
,
75 int sx
, int sy
, int ex
, int ey
, int scale
)
77 if (ch
>= solo_dev
->nr_chans
)
80 /* Here, we just keep window/channel the same */
81 solo_reg_write(solo_dev
, SOLO_VI_WIN_CTRL0(ch
),
82 SOLO_VI_WIN_CHANNEL(ch
) |
85 SOLO_VI_WIN_SCALE(scale
));
87 solo_reg_write(solo_dev
, SOLO_VI_WIN_CTRL1(ch
),
92 static int solo_v4l2_ch_ext_4up(struct solo_dev
*solo_dev
, u8 idx
, int on
)
96 if (ch
>= solo_dev
->nr_chans
)
101 for (i
= ch
; i
< ch
+ 4; i
++)
102 solo_win_setup(solo_dev
, i
, solo_dev
->video_hsize
,
103 solo_vlines(solo_dev
),
104 solo_dev
->video_hsize
,
105 solo_vlines(solo_dev
), 0);
110 solo_win_setup(solo_dev
, ch
, 0, 0, solo_dev
->video_hsize
/ 2,
111 solo_vlines(solo_dev
) / 2, 3);
112 solo_win_setup(solo_dev
, ch
+ 1, solo_dev
->video_hsize
/ 2, 0,
113 solo_dev
->video_hsize
, solo_vlines(solo_dev
) / 2, 3);
115 solo_win_setup(solo_dev
, ch
+ 2, 0, solo_vlines(solo_dev
) / 2,
116 solo_dev
->video_hsize
/ 2, solo_vlines(solo_dev
), 3);
117 solo_win_setup(solo_dev
, ch
+ 3, solo_dev
->video_hsize
/ 2,
118 solo_vlines(solo_dev
) / 2, solo_dev
->video_hsize
,
119 solo_vlines(solo_dev
), 3);
124 static int solo_v4l2_ch_ext_16up(struct solo_dev
*solo_dev
, int on
)
126 int sy
, ysize
, hsize
, i
;
129 for (i
= 0; i
< 16; i
++)
130 solo_win_setup(solo_dev
, i
, solo_dev
->video_hsize
,
131 solo_vlines(solo_dev
),
132 solo_dev
->video_hsize
,
133 solo_vlines(solo_dev
), 0);
137 ysize
= solo_vlines(solo_dev
) / 4;
138 hsize
= solo_dev
->video_hsize
/ 4;
140 for (sy
= 0, i
= 0; i
< 4; i
++, sy
+= ysize
) {
141 solo_win_setup(solo_dev
, i
* 4, 0, sy
, hsize
,
143 solo_win_setup(solo_dev
, (i
* 4) + 1, hsize
, sy
,
144 hsize
* 2, sy
+ ysize
, 5);
145 solo_win_setup(solo_dev
, (i
* 4) + 2, hsize
* 2, sy
,
146 hsize
* 3, sy
+ ysize
, 5);
147 solo_win_setup(solo_dev
, (i
* 4) + 3, hsize
* 3, sy
,
148 solo_dev
->video_hsize
, sy
+ ysize
, 5);
154 static int solo_v4l2_ch(struct solo_dev
*solo_dev
, u8 ch
, int on
)
158 if (ch
< solo_dev
->nr_chans
) {
159 solo_win_setup(solo_dev
, ch
, on
? 0 : solo_dev
->video_hsize
,
160 on
? 0 : solo_vlines(solo_dev
),
161 solo_dev
->video_hsize
, solo_vlines(solo_dev
),
166 if (ch
>= solo_dev
->nr_chans
+ solo_dev
->nr_ext
)
169 ext_ch
= ch
- solo_dev
->nr_chans
;
173 return solo_v4l2_ch_ext_4up(solo_dev
, ext_ch
, on
);
175 /* Remaining case is 16up for 16-port */
176 return solo_v4l2_ch_ext_16up(solo_dev
, on
);
179 static int solo_v4l2_set_ch(struct solo_dev
*solo_dev
, u8 ch
)
181 if (ch
>= solo_dev
->nr_chans
+ solo_dev
->nr_ext
)
186 solo_v4l2_ch(solo_dev
, solo_dev
->cur_disp_ch
, 0);
187 solo_v4l2_ch(solo_dev
, ch
, 1);
189 solo_dev
->cur_disp_ch
= ch
;
194 static void solo_fillbuf(struct solo_dev
*solo_dev
,
195 struct vb2_buffer
*vb
)
198 unsigned int fdma_addr
;
202 vbuf
= vb2_dma_contig_plane_dma_addr(vb
, 0);
206 if (erase_off(solo_dev
)) {
207 void *p
= vb2_plane_vaddr(vb
, 0);
208 int image_size
= solo_image_size(solo_dev
);
209 for (i
= 0; i
< image_size
; i
+= 2) {
211 ((u8
*)p
)[i
+ 1] = 0x00;
215 fdma_addr
= SOLO_DISP_EXT_ADDR
+ (solo_dev
->old_write
*
216 (SOLO_HW_BPL
* solo_vlines(solo_dev
)));
218 error
= solo_p2m_dma_t(solo_dev
, 0, vbuf
, fdma_addr
,
219 solo_bytesperline(solo_dev
),
220 solo_vlines(solo_dev
), SOLO_HW_BPL
);
225 vb2_set_plane_payload(vb
, 0,
226 solo_vlines(solo_dev
) * solo_bytesperline(solo_dev
));
227 vb
->v4l2_buf
.sequence
= solo_dev
->sequence
++;
228 v4l2_get_timestamp(&vb
->v4l2_buf
.timestamp
);
231 vb2_buffer_done(vb
, error
? VB2_BUF_STATE_ERROR
: VB2_BUF_STATE_DONE
);
234 static void solo_thread_try(struct solo_dev
*solo_dev
)
236 struct solo_vb2_buf
*vb
;
238 /* Only "break" from this loop if slock is held, otherwise
241 unsigned int cur_write
;
243 cur_write
= SOLO_VI_STATUS0_PAGE(
244 solo_reg_read(solo_dev
, SOLO_VI_STATUS0
));
245 if (cur_write
== solo_dev
->old_write
)
248 spin_lock(&solo_dev
->slock
);
250 if (list_empty(&solo_dev
->vidq_active
))
253 vb
= list_first_entry(&solo_dev
->vidq_active
, struct solo_vb2_buf
,
256 solo_dev
->old_write
= cur_write
;
259 spin_unlock(&solo_dev
->slock
);
261 solo_fillbuf(solo_dev
, &vb
->vb
);
264 assert_spin_locked(&solo_dev
->slock
);
265 spin_unlock(&solo_dev
->slock
);
268 static int solo_thread(void *data
)
270 struct solo_dev
*solo_dev
= data
;
271 DECLARE_WAITQUEUE(wait
, current
);
274 add_wait_queue(&solo_dev
->disp_thread_wait
, &wait
);
277 long timeout
= schedule_timeout_interruptible(HZ
);
278 if (timeout
== -ERESTARTSYS
|| kthread_should_stop())
280 solo_thread_try(solo_dev
);
284 remove_wait_queue(&solo_dev
->disp_thread_wait
, &wait
);
289 static int solo_start_thread(struct solo_dev
*solo_dev
)
293 solo_dev
->kthread
= kthread_run(solo_thread
, solo_dev
, SOLO6X10_NAME
"_disp");
295 if (IS_ERR(solo_dev
->kthread
)) {
296 ret
= PTR_ERR(solo_dev
->kthread
);
297 solo_dev
->kthread
= NULL
;
300 solo_irq_on(solo_dev
, SOLO_IRQ_VIDEO_IN
);
305 static void solo_stop_thread(struct solo_dev
*solo_dev
)
307 if (!solo_dev
->kthread
)
310 solo_irq_off(solo_dev
, SOLO_IRQ_VIDEO_IN
);
311 kthread_stop(solo_dev
->kthread
);
312 solo_dev
->kthread
= NULL
;
315 static int solo_queue_setup(struct vb2_queue
*q
, const struct v4l2_format
*fmt
,
316 unsigned int *num_buffers
, unsigned int *num_planes
,
317 unsigned int sizes
[], void *alloc_ctxs
[])
319 struct solo_dev
*solo_dev
= vb2_get_drv_priv(q
);
321 sizes
[0] = solo_image_size(solo_dev
);
322 alloc_ctxs
[0] = solo_dev
->alloc_ctx
;
325 if (*num_buffers
< MIN_VID_BUFFERS
)
326 *num_buffers
= MIN_VID_BUFFERS
;
331 static int solo_start_streaming(struct vb2_queue
*q
, unsigned int count
)
333 struct solo_dev
*solo_dev
= vb2_get_drv_priv(q
);
335 solo_dev
->sequence
= 0;
336 return solo_start_thread(solo_dev
);
339 static int solo_stop_streaming(struct vb2_queue
*q
)
341 struct solo_dev
*solo_dev
= vb2_get_drv_priv(q
);
343 solo_stop_thread(solo_dev
);
344 INIT_LIST_HEAD(&solo_dev
->vidq_active
);
348 static void solo_buf_queue(struct vb2_buffer
*vb
)
350 struct vb2_queue
*vq
= vb
->vb2_queue
;
351 struct solo_dev
*solo_dev
= vb2_get_drv_priv(vq
);
352 struct solo_vb2_buf
*solo_vb
=
353 container_of(vb
, struct solo_vb2_buf
, vb
);
355 spin_lock(&solo_dev
->slock
);
356 list_add_tail(&solo_vb
->list
, &solo_dev
->vidq_active
);
357 spin_unlock(&solo_dev
->slock
);
358 wake_up_interruptible(&solo_dev
->disp_thread_wait
);
361 static const struct vb2_ops solo_video_qops
= {
362 .queue_setup
= solo_queue_setup
,
363 .buf_queue
= solo_buf_queue
,
364 .start_streaming
= solo_start_streaming
,
365 .stop_streaming
= solo_stop_streaming
,
366 .wait_prepare
= vb2_ops_wait_prepare
,
367 .wait_finish
= vb2_ops_wait_finish
,
370 static int solo_querycap(struct file
*file
, void *priv
,
371 struct v4l2_capability
*cap
)
373 struct solo_dev
*solo_dev
= video_drvdata(file
);
375 strcpy(cap
->driver
, SOLO6X10_NAME
);
376 strcpy(cap
->card
, "Softlogic 6x10");
377 snprintf(cap
->bus_info
, sizeof(cap
->bus_info
), "PCI:%s",
378 pci_name(solo_dev
->pdev
));
379 cap
->device_caps
= V4L2_CAP_VIDEO_CAPTURE
|
380 V4L2_CAP_READWRITE
| V4L2_CAP_STREAMING
;
381 cap
->capabilities
= cap
->device_caps
| V4L2_CAP_DEVICE_CAPS
;
385 static int solo_enum_ext_input(struct solo_dev
*solo_dev
,
386 struct v4l2_input
*input
)
388 static const char * const dispnames_1
[] = { "4UP" };
389 static const char * const dispnames_2
[] = { "4UP-1", "4UP-2" };
390 static const char * const dispnames_5
[] = {
391 "4UP-1", "4UP-2", "4UP-3", "4UP-4", "16UP"
393 const char * const *dispnames
;
395 if (input
->index
>= (solo_dev
->nr_chans
+ solo_dev
->nr_ext
))
398 if (solo_dev
->nr_ext
== 5)
399 dispnames
= dispnames_5
;
400 else if (solo_dev
->nr_ext
== 2)
401 dispnames
= dispnames_2
;
403 dispnames
= dispnames_1
;
405 snprintf(input
->name
, sizeof(input
->name
), "Multi %s",
406 dispnames
[input
->index
- solo_dev
->nr_chans
]);
411 static int solo_enum_input(struct file
*file
, void *priv
,
412 struct v4l2_input
*input
)
414 struct solo_dev
*solo_dev
= video_drvdata(file
);
416 if (input
->index
>= solo_dev
->nr_chans
) {
417 int ret
= solo_enum_ext_input(solo_dev
, input
);
421 snprintf(input
->name
, sizeof(input
->name
), "Camera %d",
424 /* We can only check this for normal inputs */
425 if (!tw28_get_video_status(solo_dev
, input
->index
))
426 input
->status
= V4L2_IN_ST_NO_SIGNAL
;
429 input
->type
= V4L2_INPUT_TYPE_CAMERA
;
430 input
->std
= solo_dev
->vfd
->tvnorms
;
434 static int solo_set_input(struct file
*file
, void *priv
, unsigned int index
)
436 struct solo_dev
*solo_dev
= video_drvdata(file
);
437 int ret
= solo_v4l2_set_ch(solo_dev
, index
);
440 while (erase_off(solo_dev
))
447 static int solo_get_input(struct file
*file
, void *priv
, unsigned int *index
)
449 struct solo_dev
*solo_dev
= video_drvdata(file
);
451 *index
= solo_dev
->cur_disp_ch
;
456 static int solo_enum_fmt_cap(struct file
*file
, void *priv
,
457 struct v4l2_fmtdesc
*f
)
462 f
->pixelformat
= V4L2_PIX_FMT_UYVY
;
463 strlcpy(f
->description
, "UYUV 4:2:2 Packed", sizeof(f
->description
));
468 static int solo_try_fmt_cap(struct file
*file
, void *priv
,
469 struct v4l2_format
*f
)
471 struct solo_dev
*solo_dev
= video_drvdata(file
);
472 struct v4l2_pix_format
*pix
= &f
->fmt
.pix
;
473 int image_size
= solo_image_size(solo_dev
);
475 if (pix
->pixelformat
!= V4L2_PIX_FMT_UYVY
)
478 pix
->width
= solo_dev
->video_hsize
;
479 pix
->height
= solo_vlines(solo_dev
);
480 pix
->sizeimage
= image_size
;
481 pix
->field
= V4L2_FIELD_INTERLACED
;
482 pix
->pixelformat
= V4L2_PIX_FMT_UYVY
;
483 pix
->colorspace
= V4L2_COLORSPACE_SMPTE170M
;
488 static int solo_set_fmt_cap(struct file
*file
, void *priv
,
489 struct v4l2_format
*f
)
491 struct solo_dev
*solo_dev
= video_drvdata(file
);
493 if (vb2_is_busy(&solo_dev
->vidq
))
496 /* For right now, if it doesn't match our running config,
498 return solo_try_fmt_cap(file
, priv
, f
);
501 static int solo_get_fmt_cap(struct file
*file
, void *priv
,
502 struct v4l2_format
*f
)
504 struct solo_dev
*solo_dev
= video_drvdata(file
);
505 struct v4l2_pix_format
*pix
= &f
->fmt
.pix
;
507 pix
->width
= solo_dev
->video_hsize
;
508 pix
->height
= solo_vlines(solo_dev
);
509 pix
->pixelformat
= V4L2_PIX_FMT_UYVY
;
510 pix
->field
= V4L2_FIELD_INTERLACED
;
511 pix
->sizeimage
= solo_image_size(solo_dev
);
512 pix
->colorspace
= V4L2_COLORSPACE_SMPTE170M
;
513 pix
->bytesperline
= solo_bytesperline(solo_dev
);
519 static int solo_g_std(struct file
*file
, void *priv
, v4l2_std_id
*i
)
521 struct solo_dev
*solo_dev
= video_drvdata(file
);
523 if (solo_dev
->video_type
== SOLO_VO_FMT_TYPE_NTSC
)
524 *i
= V4L2_STD_NTSC_M
;
530 int solo_set_video_type(struct solo_dev
*solo_dev
, bool is_50hz
)
534 /* Make sure all video nodes are idle */
535 if (vb2_is_busy(&solo_dev
->vidq
))
537 for (i
= 0; i
< solo_dev
->nr_chans
; i
++)
538 if (vb2_is_busy(&solo_dev
->v4l2_enc
[i
]->vidq
))
540 solo_dev
->video_type
= is_50hz
? SOLO_VO_FMT_TYPE_PAL
:
541 SOLO_VO_FMT_TYPE_NTSC
;
542 /* Reconfigure for the new standard */
543 solo_disp_init(solo_dev
);
544 solo_enc_init(solo_dev
);
545 solo_tw28_init(solo_dev
);
546 for (i
= 0; i
< solo_dev
->nr_chans
; i
++)
547 solo_update_mode(solo_dev
->v4l2_enc
[i
]);
548 return solo_v4l2_set_ch(solo_dev
, solo_dev
->cur_disp_ch
);
551 static int solo_s_std(struct file
*file
, void *priv
, v4l2_std_id std
)
553 struct solo_dev
*solo_dev
= video_drvdata(file
);
555 return solo_set_video_type(solo_dev
, std
& V4L2_STD_625_50
);
558 static int solo_s_ctrl(struct v4l2_ctrl
*ctrl
)
560 struct solo_dev
*solo_dev
=
561 container_of(ctrl
->handler
, struct solo_dev
, disp_hdl
);
564 case V4L2_CID_MOTION_TRACE
:
566 solo_reg_write(solo_dev
, SOLO_VI_MOTION_BORDER
,
567 SOLO_VI_MOTION_Y_ADD
|
568 SOLO_VI_MOTION_Y_VALUE(0x20) |
569 SOLO_VI_MOTION_CB_VALUE(0x10) |
570 SOLO_VI_MOTION_CR_VALUE(0x10));
571 solo_reg_write(solo_dev
, SOLO_VI_MOTION_BAR
,
572 SOLO_VI_MOTION_CR_ADD
|
573 SOLO_VI_MOTION_Y_VALUE(0x10) |
574 SOLO_VI_MOTION_CB_VALUE(0x80) |
575 SOLO_VI_MOTION_CR_VALUE(0x10));
577 solo_reg_write(solo_dev
, SOLO_VI_MOTION_BORDER
, 0);
578 solo_reg_write(solo_dev
, SOLO_VI_MOTION_BAR
, 0);
587 static const struct v4l2_file_operations solo_v4l2_fops
= {
588 .owner
= THIS_MODULE
,
589 .open
= v4l2_fh_open
,
590 .release
= vb2_fop_release
,
591 .read
= vb2_fop_read
,
592 .poll
= vb2_fop_poll
,
593 .mmap
= vb2_fop_mmap
,
594 .unlocked_ioctl
= video_ioctl2
,
597 static const struct v4l2_ioctl_ops solo_v4l2_ioctl_ops
= {
598 .vidioc_querycap
= solo_querycap
,
599 .vidioc_s_std
= solo_s_std
,
600 .vidioc_g_std
= solo_g_std
,
601 /* Input callbacks */
602 .vidioc_enum_input
= solo_enum_input
,
603 .vidioc_s_input
= solo_set_input
,
604 .vidioc_g_input
= solo_get_input
,
605 /* Video capture format callbacks */
606 .vidioc_enum_fmt_vid_cap
= solo_enum_fmt_cap
,
607 .vidioc_try_fmt_vid_cap
= solo_try_fmt_cap
,
608 .vidioc_s_fmt_vid_cap
= solo_set_fmt_cap
,
609 .vidioc_g_fmt_vid_cap
= solo_get_fmt_cap
,
611 .vidioc_reqbufs
= vb2_ioctl_reqbufs
,
612 .vidioc_querybuf
= vb2_ioctl_querybuf
,
613 .vidioc_qbuf
= vb2_ioctl_qbuf
,
614 .vidioc_dqbuf
= vb2_ioctl_dqbuf
,
615 .vidioc_streamon
= vb2_ioctl_streamon
,
616 .vidioc_streamoff
= vb2_ioctl_streamoff
,
617 /* Logging and events */
618 .vidioc_log_status
= v4l2_ctrl_log_status
,
619 .vidioc_subscribe_event
= v4l2_ctrl_subscribe_event
,
620 .vidioc_unsubscribe_event
= v4l2_event_unsubscribe
,
623 static struct video_device solo_v4l2_template
= {
624 .name
= SOLO6X10_NAME
,
625 .fops
= &solo_v4l2_fops
,
626 .ioctl_ops
= &solo_v4l2_ioctl_ops
,
628 .release
= video_device_release
,
629 .tvnorms
= V4L2_STD_NTSC_M
| V4L2_STD_PAL
,
632 static const struct v4l2_ctrl_ops solo_ctrl_ops
= {
633 .s_ctrl
= solo_s_ctrl
,
636 static const struct v4l2_ctrl_config solo_motion_trace_ctrl
= {
637 .ops
= &solo_ctrl_ops
,
638 .id
= V4L2_CID_MOTION_TRACE
,
639 .name
= "Motion Detection Trace",
640 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
645 int solo_v4l2_init(struct solo_dev
*solo_dev
, unsigned nr
)
650 init_waitqueue_head(&solo_dev
->disp_thread_wait
);
651 spin_lock_init(&solo_dev
->slock
);
652 mutex_init(&solo_dev
->lock
);
653 INIT_LIST_HEAD(&solo_dev
->vidq_active
);
655 solo_dev
->vfd
= video_device_alloc();
659 *solo_dev
->vfd
= solo_v4l2_template
;
660 solo_dev
->vfd
->v4l2_dev
= &solo_dev
->v4l2_dev
;
661 solo_dev
->vfd
->queue
= &solo_dev
->vidq
;
662 solo_dev
->vfd
->lock
= &solo_dev
->lock
;
663 v4l2_ctrl_handler_init(&solo_dev
->disp_hdl
, 1);
664 v4l2_ctrl_new_custom(&solo_dev
->disp_hdl
, &solo_motion_trace_ctrl
, NULL
);
665 if (solo_dev
->disp_hdl
.error
) {
666 ret
= solo_dev
->disp_hdl
.error
;
669 solo_dev
->vfd
->ctrl_handler
= &solo_dev
->disp_hdl
;
670 set_bit(V4L2_FL_USE_FH_PRIO
, &solo_dev
->vfd
->flags
);
672 video_set_drvdata(solo_dev
->vfd
, solo_dev
);
674 solo_dev
->vidq
.type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
675 solo_dev
->vidq
.io_modes
= VB2_MMAP
| VB2_USERPTR
| VB2_READ
;
676 solo_dev
->vidq
.ops
= &solo_video_qops
;
677 solo_dev
->vidq
.mem_ops
= &vb2_dma_contig_memops
;
678 solo_dev
->vidq
.drv_priv
= solo_dev
;
679 solo_dev
->vidq
.timestamp_type
= V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC
;
680 solo_dev
->vidq
.gfp_flags
= __GFP_DMA32
;
681 solo_dev
->vidq
.buf_struct_size
= sizeof(struct solo_vb2_buf
);
682 solo_dev
->vidq
.lock
= &solo_dev
->lock
;
683 ret
= vb2_queue_init(&solo_dev
->vidq
);
687 solo_dev
->alloc_ctx
= vb2_dma_contig_init_ctx(&solo_dev
->pdev
->dev
);
688 if (IS_ERR(solo_dev
->alloc_ctx
)) {
689 dev_err(&solo_dev
->pdev
->dev
, "Can't allocate buffer context");
690 return PTR_ERR(solo_dev
->alloc_ctx
);
693 /* Cycle all the channels and clear */
694 for (i
= 0; i
< solo_dev
->nr_chans
; i
++) {
695 solo_v4l2_set_ch(solo_dev
, i
);
696 while (erase_off(solo_dev
))
700 /* Set the default display channel */
701 solo_v4l2_set_ch(solo_dev
, 0);
702 while (erase_off(solo_dev
))
705 ret
= video_register_device(solo_dev
->vfd
, VFL_TYPE_GRABBER
, nr
);
709 snprintf(solo_dev
->vfd
->name
, sizeof(solo_dev
->vfd
->name
), "%s (%i)",
710 SOLO6X10_NAME
, solo_dev
->vfd
->num
);
712 dev_info(&solo_dev
->pdev
->dev
, "Display as /dev/video%d with "
713 "%d inputs (%d extended)\n", solo_dev
->vfd
->num
,
714 solo_dev
->nr_chans
, solo_dev
->nr_ext
);
719 video_device_release(solo_dev
->vfd
);
720 vb2_dma_contig_cleanup_ctx(solo_dev
->alloc_ctx
);
721 v4l2_ctrl_handler_free(&solo_dev
->disp_hdl
);
722 solo_dev
->vfd
= NULL
;
726 void solo_v4l2_exit(struct solo_dev
*solo_dev
)
728 if (solo_dev
->vfd
== NULL
)
731 video_unregister_device(solo_dev
->vfd
);
732 vb2_dma_contig_cleanup_ctx(solo_dev
->alloc_ctx
);
733 v4l2_ctrl_handler_free(&solo_dev
->disp_hdl
);
734 solo_dev
->vfd
= NULL
;