1 // SPDX-License-Identifier: GPL-2.0-only
2 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
4 #include <media/drv-intf/saa7146_vv.h>
5 #include <linux/module.h>
7 /****************************************************************************/
8 /* resource management functions, shamelessly stolen from saa7134 driver */
10 int saa7146_res_get(struct saa7146_fh
*fh
, unsigned int bit
)
12 struct saa7146_dev
*dev
= fh
->dev
;
13 struct saa7146_vv
*vv
= dev
->vv_data
;
15 if (fh
->resources
& bit
) {
16 DEB_D("already allocated! want: 0x%02x, cur:0x%02x\n",
18 /* have it already allocated */
23 if (vv
->resources
& bit
) {
24 DEB_D("locked! vv->resources:0x%02x, we want:0x%02x\n",
26 /* no, someone else uses it */
29 /* it's free, grab it */
32 DEB_D("res: get 0x%02x, cur:0x%02x\n", bit
, vv
->resources
);
36 void saa7146_res_free(struct saa7146_fh
*fh
, unsigned int bits
)
38 struct saa7146_dev
*dev
= fh
->dev
;
39 struct saa7146_vv
*vv
= dev
->vv_data
;
41 BUG_ON((fh
->resources
& bits
) != bits
);
43 fh
->resources
&= ~bits
;
44 vv
->resources
&= ~bits
;
45 DEB_D("res: put 0x%02x, cur:0x%02x\n", bits
, vv
->resources
);
49 /********************************************************************************/
50 /* common dma functions */
52 void saa7146_dma_free(struct saa7146_dev
*dev
,struct videobuf_queue
*q
,
53 struct saa7146_buf
*buf
)
55 struct videobuf_dmabuf
*dma
=videobuf_to_dma(&buf
->vb
);
56 DEB_EE("dev:%p, buf:%p\n", dev
, buf
);
58 videobuf_waiton(q
, &buf
->vb
, 0, 0);
59 videobuf_dma_unmap(q
->dev
, dma
);
60 videobuf_dma_free(dma
);
61 buf
->vb
.state
= VIDEOBUF_NEEDS_INIT
;
65 /********************************************************************************/
66 /* common buffer functions */
68 int saa7146_buffer_queue(struct saa7146_dev
*dev
,
69 struct saa7146_dmaqueue
*q
,
70 struct saa7146_buf
*buf
)
72 assert_spin_locked(&dev
->slock
);
73 DEB_EE("dev:%p, dmaq:%p, buf:%p\n", dev
, q
, buf
);
77 if (NULL
== q
->curr
) {
79 DEB_D("immediately activating buffer %p\n", buf
);
80 buf
->activate(dev
,buf
,NULL
);
82 list_add_tail(&buf
->vb
.queue
,&q
->queue
);
83 buf
->vb
.state
= VIDEOBUF_QUEUED
;
84 DEB_D("adding buffer %p to queue. (active buffer present)\n",
90 void saa7146_buffer_finish(struct saa7146_dev
*dev
,
91 struct saa7146_dmaqueue
*q
,
94 assert_spin_locked(&dev
->slock
);
95 DEB_EE("dev:%p, dmaq:%p, state:%d\n", dev
, q
, state
);
96 DEB_EE("q->curr:%p\n", q
->curr
);
98 /* finish current buffer */
99 if (NULL
== q
->curr
) {
100 DEB_D("aiii. no current buffer\n");
104 q
->curr
->vb
.state
= state
;
105 q
->curr
->vb
.ts
= ktime_get_ns();
106 wake_up(&q
->curr
->vb
.done
);
111 void saa7146_buffer_next(struct saa7146_dev
*dev
,
112 struct saa7146_dmaqueue
*q
, int vbi
)
114 struct saa7146_buf
*buf
,*next
= NULL
;
118 DEB_INT("dev:%p, dmaq:%p, vbi:%d\n", dev
, q
, vbi
);
120 assert_spin_locked(&dev
->slock
);
121 if (!list_empty(&q
->queue
)) {
122 /* activate next one from queue */
123 buf
= list_entry(q
->queue
.next
,struct saa7146_buf
,vb
.queue
);
124 list_del(&buf
->vb
.queue
);
125 if (!list_empty(&q
->queue
))
126 next
= list_entry(q
->queue
.next
,struct saa7146_buf
, vb
.queue
);
128 DEB_INT("next buffer: buf:%p, prev:%p, next:%p\n",
129 buf
, q
->queue
.prev
, q
->queue
.next
);
130 buf
->activate(dev
,buf
,next
);
132 DEB_INT("no next buffer. stopping.\n");
134 /* turn off video-dma3 */
135 saa7146_write(dev
,MC1
, MASK_20
);
137 /* nothing to do -- just prevent next video-dma1 transfer
138 by lowering the protection address */
140 // fixme: fix this for vflip != 0
142 saa7146_write(dev
, PROT_ADDR1
, 0);
143 saa7146_write(dev
, MC2
, (MASK_02
|MASK_18
));
145 /* write the address of the rps-program */
146 saa7146_write(dev
, RPS_ADDR0
, dev
->d_rps0
.dma_handle
);
148 saa7146_write(dev
, MC1
, (MASK_12
| MASK_28
));
151 printk("vdma%d.base_even: 0x%08x\n", 1,saa7146_read(dev,BASE_EVEN1));
152 printk("vdma%d.base_odd: 0x%08x\n", 1,saa7146_read(dev,BASE_ODD1));
153 printk("vdma%d.prot_addr: 0x%08x\n", 1,saa7146_read(dev,PROT_ADDR1));
154 printk("vdma%d.base_page: 0x%08x\n", 1,saa7146_read(dev,BASE_PAGE1));
155 printk("vdma%d.pitch: 0x%08x\n", 1,saa7146_read(dev,PITCH1));
156 printk("vdma%d.num_line_byte: 0x%08x\n", 1,saa7146_read(dev,NUM_LINE_BYTE1));
159 del_timer(&q
->timeout
);
163 void saa7146_buffer_timeout(struct timer_list
*t
)
165 struct saa7146_dmaqueue
*q
= from_timer(q
, t
, timeout
);
166 struct saa7146_dev
*dev
= q
->dev
;
169 DEB_EE("dev:%p, dmaq:%p\n", dev
, q
);
171 spin_lock_irqsave(&dev
->slock
,flags
);
173 DEB_D("timeout on %p\n", q
->curr
);
174 saa7146_buffer_finish(dev
,q
,VIDEOBUF_ERROR
);
177 /* we don't restart the transfer here like other drivers do. when
178 a streaming capture is disabled, the timeout function will be
179 called for the current buffer. if we activate the next buffer now,
180 we mess up our capture logic. if a timeout occurs on another buffer,
181 then something is seriously broken before, so no need to buffer the
182 next capture IMHO... */
184 saa7146_buffer_next(dev,q);
186 spin_unlock_irqrestore(&dev
->slock
,flags
);
189 /********************************************************************************/
190 /* file operations */
192 static int fops_open(struct file
*file
)
194 struct video_device
*vdev
= video_devdata(file
);
195 struct saa7146_dev
*dev
= video_drvdata(file
);
196 struct saa7146_fh
*fh
= NULL
;
199 DEB_EE("file:%p, dev:%s\n", file
, video_device_node_name(vdev
));
201 if (mutex_lock_interruptible(vdev
->lock
))
204 DEB_D("using: %p\n", dev
);
206 /* check if an extension is registered */
207 if( NULL
== dev
->ext
) {
208 DEB_S("no extension registered for this device\n");
213 /* allocate per open data */
214 fh
= kzalloc(sizeof(*fh
),GFP_KERNEL
);
216 DEB_S("cannot allocate memory for per open data\n");
221 v4l2_fh_init(&fh
->fh
, vdev
);
223 file
->private_data
= &fh
->fh
;
226 if (vdev
->vfl_type
== VFL_TYPE_VBI
) {
227 DEB_S("initializing vbi...\n");
228 if (dev
->ext_vv_data
->capabilities
& V4L2_CAP_VBI_CAPTURE
)
229 result
= saa7146_vbi_uops
.open(dev
,file
);
230 if (dev
->ext_vv_data
->vbi_fops
.open
)
231 dev
->ext_vv_data
->vbi_fops
.open(file
);
233 DEB_S("initializing video...\n");
234 result
= saa7146_video_uops
.open(dev
,file
);
241 if( 0 == try_module_get(dev
->ext
->module
)) {
247 v4l2_fh_add(&fh
->fh
);
249 if (fh
&& result
!= 0) {
251 file
->private_data
= NULL
;
253 mutex_unlock(vdev
->lock
);
257 static int fops_release(struct file
*file
)
259 struct video_device
*vdev
= video_devdata(file
);
260 struct saa7146_fh
*fh
= file
->private_data
;
261 struct saa7146_dev
*dev
= fh
->dev
;
263 DEB_EE("file:%p\n", file
);
265 mutex_lock(vdev
->lock
);
267 if (vdev
->vfl_type
== VFL_TYPE_VBI
) {
268 if (dev
->ext_vv_data
->capabilities
& V4L2_CAP_VBI_CAPTURE
)
269 saa7146_vbi_uops
.release(dev
,file
);
270 if (dev
->ext_vv_data
->vbi_fops
.release
)
271 dev
->ext_vv_data
->vbi_fops
.release(file
);
273 saa7146_video_uops
.release(dev
,file
);
276 v4l2_fh_del(&fh
->fh
);
277 v4l2_fh_exit(&fh
->fh
);
278 module_put(dev
->ext
->module
);
279 file
->private_data
= NULL
;
282 mutex_unlock(vdev
->lock
);
287 static int fops_mmap(struct file
*file
, struct vm_area_struct
* vma
)
289 struct video_device
*vdev
= video_devdata(file
);
290 struct saa7146_fh
*fh
= file
->private_data
;
291 struct videobuf_queue
*q
;
294 switch (vdev
->vfl_type
) {
295 case VFL_TYPE_VIDEO
: {
296 DEB_EE("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, vma:%p\n",
302 DEB_EE("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, vma:%p\n",
304 if (fh
->dev
->ext_vv_data
->capabilities
& V4L2_CAP_SLICED_VBI_OUTPUT
)
313 if (mutex_lock_interruptible(vdev
->lock
))
315 res
= videobuf_mmap_mapper(q
, vma
);
316 mutex_unlock(vdev
->lock
);
320 static __poll_t
__fops_poll(struct file
*file
, struct poll_table_struct
*wait
)
322 struct video_device
*vdev
= video_devdata(file
);
323 struct saa7146_fh
*fh
= file
->private_data
;
324 struct videobuf_buffer
*buf
= NULL
;
325 struct videobuf_queue
*q
;
326 __poll_t res
= v4l2_ctrl_poll(file
, wait
);
328 DEB_EE("file:%p, poll:%p\n", file
, wait
);
330 if (vdev
->vfl_type
== VFL_TYPE_VBI
) {
331 if (fh
->dev
->ext_vv_data
->capabilities
& V4L2_CAP_SLICED_VBI_OUTPUT
)
332 return res
| EPOLLOUT
| EPOLLWRNORM
;
333 if( 0 == fh
->vbi_q
.streaming
)
334 return res
| videobuf_poll_stream(file
, &fh
->vbi_q
, wait
);
337 DEB_D("using video queue\n");
341 if (!list_empty(&q
->stream
))
342 buf
= list_entry(q
->stream
.next
, struct videobuf_buffer
, stream
);
345 DEB_D("buf == NULL!\n");
346 return res
| EPOLLERR
;
349 poll_wait(file
, &buf
->done
, wait
);
350 if (buf
->state
== VIDEOBUF_DONE
|| buf
->state
== VIDEOBUF_ERROR
) {
351 DEB_D("poll succeeded!\n");
352 return res
| EPOLLIN
| EPOLLRDNORM
;
355 DEB_D("nothing to poll for, buf->state:%d\n", buf
->state
);
359 static __poll_t
fops_poll(struct file
*file
, struct poll_table_struct
*wait
)
361 struct video_device
*vdev
= video_devdata(file
);
364 mutex_lock(vdev
->lock
);
365 res
= __fops_poll(file
, wait
);
366 mutex_unlock(vdev
->lock
);
370 static ssize_t
fops_read(struct file
*file
, char __user
*data
, size_t count
, loff_t
*ppos
)
372 struct video_device
*vdev
= video_devdata(file
);
373 struct saa7146_fh
*fh
= file
->private_data
;
376 switch (vdev
->vfl_type
) {
379 DEB_EE("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, data:%p, count:%lun",
380 file, data, (unsigned long)count);
382 return saa7146_video_uops
.read(file
,data
,count
,ppos
);
385 DEB_EE("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, data:%p, count:%lu\n",
386 file, data, (unsigned long)count);
388 if (fh
->dev
->ext_vv_data
->capabilities
& V4L2_CAP_VBI_CAPTURE
) {
389 if (mutex_lock_interruptible(vdev
->lock
))
391 ret
= saa7146_vbi_uops
.read(file
, data
, count
, ppos
);
392 mutex_unlock(vdev
->lock
);
401 static ssize_t
fops_write(struct file
*file
, const char __user
*data
, size_t count
, loff_t
*ppos
)
403 struct video_device
*vdev
= video_devdata(file
);
404 struct saa7146_fh
*fh
= file
->private_data
;
407 switch (vdev
->vfl_type
) {
411 if (fh
->dev
->ext_vv_data
->vbi_fops
.write
) {
412 if (mutex_lock_interruptible(vdev
->lock
))
414 ret
= fh
->dev
->ext_vv_data
->vbi_fops
.write(file
, data
, count
, ppos
);
415 mutex_unlock(vdev
->lock
);
424 static const struct v4l2_file_operations video_fops
=
426 .owner
= THIS_MODULE
,
428 .release
= fops_release
,
433 .unlocked_ioctl
= video_ioctl2
,
436 static void vv_callback(struct saa7146_dev
*dev
, unsigned long status
)
440 DEB_INT("dev:%p, isr:0x%08x\n", dev
, (u32
)status
);
442 if (0 != (isr
& (MASK_27
))) {
443 DEB_INT("irq: RPS0 (0x%08x)\n", isr
);
444 saa7146_video_uops
.irq_done(dev
,isr
);
447 if (0 != (isr
& (MASK_28
))) {
448 u32 mc2
= saa7146_read(dev
, MC2
);
449 if( 0 != (mc2
& MASK_15
)) {
450 DEB_INT("irq: RPS1 vbi workaround (0x%08x)\n", isr
);
451 wake_up(&dev
->vv_data
->vbi_wq
);
452 saa7146_write(dev
,MC2
, MASK_31
);
455 DEB_INT("irq: RPS1 (0x%08x)\n", isr
);
456 saa7146_vbi_uops
.irq_done(dev
,isr
);
460 static const struct v4l2_ctrl_ops saa7146_ctrl_ops
= {
461 .s_ctrl
= saa7146_s_ctrl
,
464 int saa7146_vv_init(struct saa7146_dev
* dev
, struct saa7146_ext_vv
*ext_vv
)
466 struct v4l2_ctrl_handler
*hdl
= &dev
->ctrl_handler
;
467 struct v4l2_pix_format
*fmt
;
468 struct v4l2_vbi_format
*vbi
;
469 struct saa7146_vv
*vv
;
472 err
= v4l2_device_register(&dev
->pci
->dev
, &dev
->v4l2_dev
);
476 v4l2_ctrl_handler_init(hdl
, 6);
477 v4l2_ctrl_new_std(hdl
, &saa7146_ctrl_ops
,
478 V4L2_CID_BRIGHTNESS
, 0, 255, 1, 128);
479 v4l2_ctrl_new_std(hdl
, &saa7146_ctrl_ops
,
480 V4L2_CID_CONTRAST
, 0, 127, 1, 64);
481 v4l2_ctrl_new_std(hdl
, &saa7146_ctrl_ops
,
482 V4L2_CID_SATURATION
, 0, 127, 1, 64);
483 v4l2_ctrl_new_std(hdl
, &saa7146_ctrl_ops
,
484 V4L2_CID_VFLIP
, 0, 1, 1, 0);
485 v4l2_ctrl_new_std(hdl
, &saa7146_ctrl_ops
,
486 V4L2_CID_HFLIP
, 0, 1, 1, 0);
489 v4l2_ctrl_handler_free(hdl
);
492 dev
->v4l2_dev
.ctrl_handler
= hdl
;
494 vv
= kzalloc(sizeof(struct saa7146_vv
), GFP_KERNEL
);
496 ERR("out of memory. aborting.\n");
497 v4l2_ctrl_handler_free(hdl
);
500 ext_vv
->vid_ops
= saa7146_video_ioctl_ops
;
501 ext_vv
->vbi_ops
= saa7146_vbi_ioctl_ops
;
502 ext_vv
->core_ops
= &saa7146_video_ioctl_ops
;
504 DEB_EE("dev:%p\n", dev
);
506 /* set default values for video parts of the saa7146 */
507 saa7146_write(dev
, BCS_CTRL
, 0x80400040);
509 /* enable video-port pins */
510 saa7146_write(dev
, MC1
, (MASK_10
| MASK_26
));
512 /* save per-device extension data (one extension can
513 handle different devices that might need different
514 configuration data) */
515 dev
->ext_vv_data
= ext_vv
;
517 vv
->d_clipping
.cpu_addr
=
518 dma_alloc_coherent(&dev
->pci
->dev
, SAA7146_CLIPPING_MEM
,
519 &vv
->d_clipping
.dma_handle
, GFP_KERNEL
);
520 if( NULL
== vv
->d_clipping
.cpu_addr
) {
521 ERR("out of memory. aborting.\n");
523 v4l2_ctrl_handler_free(hdl
);
527 saa7146_video_uops
.init(dev
,vv
);
528 if (dev
->ext_vv_data
->capabilities
& V4L2_CAP_VBI_CAPTURE
)
529 saa7146_vbi_uops
.init(dev
,vv
);
531 vv
->ov_fb
.fmt
.width
= vv
->standard
->h_max_out
;
532 vv
->ov_fb
.fmt
.height
= vv
->standard
->v_max_out
;
533 vv
->ov_fb
.fmt
.pixelformat
= V4L2_PIX_FMT_RGB565
;
534 vv
->ov_fb
.fmt
.bytesperline
= 2 * vv
->ov_fb
.fmt
.width
;
535 vv
->ov_fb
.fmt
.sizeimage
= vv
->ov_fb
.fmt
.bytesperline
* vv
->ov_fb
.fmt
.height
;
536 vv
->ov_fb
.fmt
.colorspace
= V4L2_COLORSPACE_SRGB
;
538 fmt
= &vv
->video_fmt
;
541 fmt
->pixelformat
= V4L2_PIX_FMT_BGR24
;
542 fmt
->field
= V4L2_FIELD_ANY
;
543 fmt
->colorspace
= V4L2_COLORSPACE_SMPTE170M
;
544 fmt
->bytesperline
= 3 * fmt
->width
;
545 fmt
->sizeimage
= fmt
->bytesperline
* fmt
->height
;
548 vbi
->sampling_rate
= 27000000;
549 vbi
->offset
= 248; /* todo */
550 vbi
->samples_per_line
= 720 * 2;
551 vbi
->sample_format
= V4L2_PIX_FMT_GREY
;
553 /* fixme: this only works for PAL */
559 timer_setup(&vv
->vbi_read_timeout
, NULL
, 0);
561 vv
->ov_fb
.capability
= V4L2_FBUF_CAP_LIST_CLIPPING
;
562 vv
->ov_fb
.flags
= V4L2_FBUF_FLAG_PRIMARY
;
564 dev
->vv_callback
= &vv_callback
;
568 EXPORT_SYMBOL_GPL(saa7146_vv_init
);
570 int saa7146_vv_release(struct saa7146_dev
* dev
)
572 struct saa7146_vv
*vv
= dev
->vv_data
;
574 DEB_EE("dev:%p\n", dev
);
576 v4l2_device_unregister(&dev
->v4l2_dev
);
577 dma_free_coherent(&dev
->pci
->dev
, SAA7146_CLIPPING_MEM
,
578 vv
->d_clipping
.cpu_addr
, vv
->d_clipping
.dma_handle
);
579 v4l2_ctrl_handler_free(&dev
->ctrl_handler
);
582 dev
->vv_callback
= NULL
;
586 EXPORT_SYMBOL_GPL(saa7146_vv_release
);
588 int saa7146_register_device(struct video_device
*vfd
, struct saa7146_dev
*dev
,
589 char *name
, int type
)
594 DEB_EE("dev:%p, name:'%s', type:%d\n", dev
, name
, type
);
596 vfd
->fops
= &video_fops
;
597 if (type
== VFL_TYPE_VIDEO
)
598 vfd
->ioctl_ops
= &dev
->ext_vv_data
->vid_ops
;
600 vfd
->ioctl_ops
= &dev
->ext_vv_data
->vbi_ops
;
601 vfd
->release
= video_device_release_empty
;
602 vfd
->lock
= &dev
->v4l2_lock
;
603 vfd
->v4l2_dev
= &dev
->v4l2_dev
;
605 for (i
= 0; i
< dev
->ext_vv_data
->num_stds
; i
++)
606 vfd
->tvnorms
|= dev
->ext_vv_data
->stds
[i
].id
;
607 strscpy(vfd
->name
, name
, sizeof(vfd
->name
));
608 vfd
->device_caps
= V4L2_CAP_VIDEO_CAPTURE
| V4L2_CAP_VIDEO_OVERLAY
|
609 V4L2_CAP_READWRITE
| V4L2_CAP_STREAMING
;
610 vfd
->device_caps
|= dev
->ext_vv_data
->capabilities
;
611 if (type
== VFL_TYPE_VIDEO
)
613 ~(V4L2_CAP_VBI_CAPTURE
| V4L2_CAP_SLICED_VBI_OUTPUT
);
616 ~(V4L2_CAP_VIDEO_CAPTURE
| V4L2_CAP_VIDEO_OVERLAY
| V4L2_CAP_AUDIO
);
617 video_set_drvdata(vfd
, dev
);
619 err
= video_register_device(vfd
, type
, -1);
621 ERR("cannot register v4l2 device. skipping.\n");
625 pr_info("%s: registered device %s [v4l2]\n",
626 dev
->name
, video_device_node_name(vfd
));
629 EXPORT_SYMBOL_GPL(saa7146_register_device
);
631 int saa7146_unregister_device(struct video_device
*vfd
, struct saa7146_dev
*dev
)
633 DEB_EE("dev:%p\n", dev
);
635 video_unregister_device(vfd
);
638 EXPORT_SYMBOL_GPL(saa7146_unregister_device
);
640 static int __init
saa7146_vv_init_module(void)
646 static void __exit
saa7146_vv_cleanup_module(void)
650 module_init(saa7146_vv_init_module
);
651 module_exit(saa7146_vv_cleanup_module
);
653 MODULE_AUTHOR("Michael Hunold <michael@mihu.de>");
654 MODULE_DESCRIPTION("video4linux driver for saa7146-based hardware");
655 MODULE_LICENSE("GPL");