1 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
3 #include <media/drv-intf/saa7146_vv.h>
4 #include <linux/module.h>
6 /****************************************************************************/
7 /* resource management functions, shamelessly stolen from saa7134 driver */
9 int saa7146_res_get(struct saa7146_fh
*fh
, unsigned int bit
)
11 struct saa7146_dev
*dev
= fh
->dev
;
12 struct saa7146_vv
*vv
= dev
->vv_data
;
14 if (fh
->resources
& bit
) {
15 DEB_D("already allocated! want: 0x%02x, cur:0x%02x\n",
17 /* have it already allocated */
22 if (vv
->resources
& bit
) {
23 DEB_D("locked! vv->resources:0x%02x, we want:0x%02x\n",
25 /* no, someone else uses it */
28 /* it's free, grab it */
31 DEB_D("res: get 0x%02x, cur:0x%02x\n", bit
, vv
->resources
);
35 void saa7146_res_free(struct saa7146_fh
*fh
, unsigned int bits
)
37 struct saa7146_dev
*dev
= fh
->dev
;
38 struct saa7146_vv
*vv
= dev
->vv_data
;
40 BUG_ON((fh
->resources
& bits
) != bits
);
42 fh
->resources
&= ~bits
;
43 vv
->resources
&= ~bits
;
44 DEB_D("res: put 0x%02x, cur:0x%02x\n", bits
, vv
->resources
);
48 /********************************************************************************/
49 /* common dma functions */
51 void saa7146_dma_free(struct saa7146_dev
*dev
,struct videobuf_queue
*q
,
52 struct saa7146_buf
*buf
)
54 struct videobuf_dmabuf
*dma
=videobuf_to_dma(&buf
->vb
);
55 DEB_EE("dev:%p, buf:%p\n", dev
, buf
);
57 BUG_ON(in_interrupt());
59 videobuf_waiton(q
, &buf
->vb
, 0, 0);
60 videobuf_dma_unmap(q
->dev
, dma
);
61 videobuf_dma_free(dma
);
62 buf
->vb
.state
= VIDEOBUF_NEEDS_INIT
;
66 /********************************************************************************/
67 /* common buffer functions */
69 int saa7146_buffer_queue(struct saa7146_dev
*dev
,
70 struct saa7146_dmaqueue
*q
,
71 struct saa7146_buf
*buf
)
73 assert_spin_locked(&dev
->slock
);
74 DEB_EE("dev:%p, dmaq:%p, buf:%p\n", dev
, q
, buf
);
78 if (NULL
== q
->curr
) {
80 DEB_D("immediately activating buffer %p\n", buf
);
81 buf
->activate(dev
,buf
,NULL
);
83 list_add_tail(&buf
->vb
.queue
,&q
->queue
);
84 buf
->vb
.state
= VIDEOBUF_QUEUED
;
85 DEB_D("adding buffer %p to queue. (active buffer present)\n",
91 void saa7146_buffer_finish(struct saa7146_dev
*dev
,
92 struct saa7146_dmaqueue
*q
,
95 assert_spin_locked(&dev
->slock
);
96 DEB_EE("dev:%p, dmaq:%p, state:%d\n", dev
, q
, state
);
97 DEB_EE("q->curr:%p\n", q
->curr
);
101 /* finish current buffer */
102 if (NULL
== q
->curr
) {
103 DEB_D("aiii. no current buffer\n");
107 q
->curr
->vb
.state
= state
;
108 v4l2_get_timestamp(&q
->curr
->vb
.ts
);
109 wake_up(&q
->curr
->vb
.done
);
114 void saa7146_buffer_next(struct saa7146_dev
*dev
,
115 struct saa7146_dmaqueue
*q
, int vbi
)
117 struct saa7146_buf
*buf
,*next
= NULL
;
121 DEB_INT("dev:%p, dmaq:%p, vbi:%d\n", dev
, q
, vbi
);
123 assert_spin_locked(&dev
->slock
);
124 if (!list_empty(&q
->queue
)) {
125 /* activate next one from queue */
126 buf
= list_entry(q
->queue
.next
,struct saa7146_buf
,vb
.queue
);
127 list_del(&buf
->vb
.queue
);
128 if (!list_empty(&q
->queue
))
129 next
= list_entry(q
->queue
.next
,struct saa7146_buf
, vb
.queue
);
131 DEB_INT("next buffer: buf:%p, prev:%p, next:%p\n",
132 buf
, q
->queue
.prev
, q
->queue
.next
);
133 buf
->activate(dev
,buf
,next
);
135 DEB_INT("no next buffer. stopping.\n");
137 /* turn off video-dma3 */
138 saa7146_write(dev
,MC1
, MASK_20
);
140 /* nothing to do -- just prevent next video-dma1 transfer
141 by lowering the protection address */
143 // fixme: fix this for vflip != 0
145 saa7146_write(dev
, PROT_ADDR1
, 0);
146 saa7146_write(dev
, MC2
, (MASK_02
|MASK_18
));
148 /* write the address of the rps-program */
149 saa7146_write(dev
, RPS_ADDR0
, dev
->d_rps0
.dma_handle
);
151 saa7146_write(dev
, MC1
, (MASK_12
| MASK_28
));
154 printk("vdma%d.base_even: 0x%08x\n", 1,saa7146_read(dev,BASE_EVEN1));
155 printk("vdma%d.base_odd: 0x%08x\n", 1,saa7146_read(dev,BASE_ODD1));
156 printk("vdma%d.prot_addr: 0x%08x\n", 1,saa7146_read(dev,PROT_ADDR1));
157 printk("vdma%d.base_page: 0x%08x\n", 1,saa7146_read(dev,BASE_PAGE1));
158 printk("vdma%d.pitch: 0x%08x\n", 1,saa7146_read(dev,PITCH1));
159 printk("vdma%d.num_line_byte: 0x%08x\n", 1,saa7146_read(dev,NUM_LINE_BYTE1));
162 del_timer(&q
->timeout
);
166 void saa7146_buffer_timeout(struct timer_list
*t
)
168 struct saa7146_dmaqueue
*q
= from_timer(q
, t
, timeout
);
169 struct saa7146_dev
*dev
= q
->dev
;
172 DEB_EE("dev:%p, dmaq:%p\n", dev
, q
);
174 spin_lock_irqsave(&dev
->slock
,flags
);
176 DEB_D("timeout on %p\n", q
->curr
);
177 saa7146_buffer_finish(dev
,q
,VIDEOBUF_ERROR
);
180 /* we don't restart the transfer here like other drivers do. when
181 a streaming capture is disabled, the timeout function will be
182 called for the current buffer. if we activate the next buffer now,
183 we mess up our capture logic. if a timeout occurs on another buffer,
184 then something is seriously broken before, so no need to buffer the
185 next capture IMHO... */
187 saa7146_buffer_next(dev,q);
189 spin_unlock_irqrestore(&dev
->slock
,flags
);
192 /********************************************************************************/
193 /* file operations */
195 static int fops_open(struct file
*file
)
197 struct video_device
*vdev
= video_devdata(file
);
198 struct saa7146_dev
*dev
= video_drvdata(file
);
199 struct saa7146_fh
*fh
= NULL
;
202 DEB_EE("file:%p, dev:%s\n", file
, video_device_node_name(vdev
));
204 if (mutex_lock_interruptible(vdev
->lock
))
207 DEB_D("using: %p\n", dev
);
209 /* check if an extension is registered */
210 if( NULL
== dev
->ext
) {
211 DEB_S("no extension registered for this device\n");
216 /* allocate per open data */
217 fh
= kzalloc(sizeof(*fh
),GFP_KERNEL
);
219 DEB_S("cannot allocate memory for per open data\n");
224 v4l2_fh_init(&fh
->fh
, vdev
);
226 file
->private_data
= &fh
->fh
;
229 if (vdev
->vfl_type
== VFL_TYPE_VBI
) {
230 DEB_S("initializing vbi...\n");
231 if (dev
->ext_vv_data
->capabilities
& V4L2_CAP_VBI_CAPTURE
)
232 result
= saa7146_vbi_uops
.open(dev
,file
);
233 if (dev
->ext_vv_data
->vbi_fops
.open
)
234 dev
->ext_vv_data
->vbi_fops
.open(file
);
236 DEB_S("initializing video...\n");
237 result
= saa7146_video_uops
.open(dev
,file
);
244 if( 0 == try_module_get(dev
->ext
->module
)) {
250 v4l2_fh_add(&fh
->fh
);
252 if (fh
&& result
!= 0) {
254 file
->private_data
= NULL
;
256 mutex_unlock(vdev
->lock
);
260 static int fops_release(struct file
*file
)
262 struct video_device
*vdev
= video_devdata(file
);
263 struct saa7146_fh
*fh
= file
->private_data
;
264 struct saa7146_dev
*dev
= fh
->dev
;
266 DEB_EE("file:%p\n", file
);
268 mutex_lock(vdev
->lock
);
270 if (vdev
->vfl_type
== VFL_TYPE_VBI
) {
271 if (dev
->ext_vv_data
->capabilities
& V4L2_CAP_VBI_CAPTURE
)
272 saa7146_vbi_uops
.release(dev
,file
);
273 if (dev
->ext_vv_data
->vbi_fops
.release
)
274 dev
->ext_vv_data
->vbi_fops
.release(file
);
276 saa7146_video_uops
.release(dev
,file
);
279 v4l2_fh_del(&fh
->fh
);
280 v4l2_fh_exit(&fh
->fh
);
281 module_put(dev
->ext
->module
);
282 file
->private_data
= NULL
;
285 mutex_unlock(vdev
->lock
);
290 static int fops_mmap(struct file
*file
, struct vm_area_struct
* vma
)
292 struct video_device
*vdev
= video_devdata(file
);
293 struct saa7146_fh
*fh
= file
->private_data
;
294 struct videobuf_queue
*q
;
297 switch (vdev
->vfl_type
) {
298 case VFL_TYPE_GRABBER
: {
299 DEB_EE("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, vma:%p\n",
305 DEB_EE("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, vma:%p\n",
307 if (fh
->dev
->ext_vv_data
->capabilities
& V4L2_CAP_SLICED_VBI_OUTPUT
)
316 if (mutex_lock_interruptible(vdev
->lock
))
318 res
= videobuf_mmap_mapper(q
, vma
);
319 mutex_unlock(vdev
->lock
);
323 static __poll_t
__fops_poll(struct file
*file
, struct poll_table_struct
*wait
)
325 struct video_device
*vdev
= video_devdata(file
);
326 struct saa7146_fh
*fh
= file
->private_data
;
327 struct videobuf_buffer
*buf
= NULL
;
328 struct videobuf_queue
*q
;
329 __poll_t res
= v4l2_ctrl_poll(file
, wait
);
331 DEB_EE("file:%p, poll:%p\n", file
, wait
);
333 if (vdev
->vfl_type
== VFL_TYPE_VBI
) {
334 if (fh
->dev
->ext_vv_data
->capabilities
& V4L2_CAP_SLICED_VBI_OUTPUT
)
335 return res
| EPOLLOUT
| EPOLLWRNORM
;
336 if( 0 == fh
->vbi_q
.streaming
)
337 return res
| videobuf_poll_stream(file
, &fh
->vbi_q
, wait
);
340 DEB_D("using video queue\n");
344 if (!list_empty(&q
->stream
))
345 buf
= list_entry(q
->stream
.next
, struct videobuf_buffer
, stream
);
348 DEB_D("buf == NULL!\n");
349 return res
| EPOLLERR
;
352 poll_wait(file
, &buf
->done
, wait
);
353 if (buf
->state
== VIDEOBUF_DONE
|| buf
->state
== VIDEOBUF_ERROR
) {
354 DEB_D("poll succeeded!\n");
355 return res
| EPOLLIN
| EPOLLRDNORM
;
358 DEB_D("nothing to poll for, buf->state:%d\n", buf
->state
);
362 static __poll_t
fops_poll(struct file
*file
, struct poll_table_struct
*wait
)
364 struct video_device
*vdev
= video_devdata(file
);
367 mutex_lock(vdev
->lock
);
368 res
= __fops_poll(file
, wait
);
369 mutex_unlock(vdev
->lock
);
373 static ssize_t
fops_read(struct file
*file
, char __user
*data
, size_t count
, loff_t
*ppos
)
375 struct video_device
*vdev
= video_devdata(file
);
376 struct saa7146_fh
*fh
= file
->private_data
;
379 switch (vdev
->vfl_type
) {
380 case VFL_TYPE_GRABBER
:
382 DEB_EE("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, data:%p, count:%lun",
383 file, data, (unsigned long)count);
385 return saa7146_video_uops
.read(file
,data
,count
,ppos
);
388 DEB_EE("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, data:%p, count:%lu\n",
389 file, data, (unsigned long)count);
391 if (fh
->dev
->ext_vv_data
->capabilities
& V4L2_CAP_VBI_CAPTURE
) {
392 if (mutex_lock_interruptible(vdev
->lock
))
394 ret
= saa7146_vbi_uops
.read(file
, data
, count
, ppos
);
395 mutex_unlock(vdev
->lock
);
404 static ssize_t
fops_write(struct file
*file
, const char __user
*data
, size_t count
, loff_t
*ppos
)
406 struct video_device
*vdev
= video_devdata(file
);
407 struct saa7146_fh
*fh
= file
->private_data
;
410 switch (vdev
->vfl_type
) {
411 case VFL_TYPE_GRABBER
:
414 if (fh
->dev
->ext_vv_data
->vbi_fops
.write
) {
415 if (mutex_lock_interruptible(vdev
->lock
))
417 ret
= fh
->dev
->ext_vv_data
->vbi_fops
.write(file
, data
, count
, ppos
);
418 mutex_unlock(vdev
->lock
);
427 static const struct v4l2_file_operations video_fops
=
429 .owner
= THIS_MODULE
,
431 .release
= fops_release
,
436 .unlocked_ioctl
= video_ioctl2
,
439 static void vv_callback(struct saa7146_dev
*dev
, unsigned long status
)
443 DEB_INT("dev:%p, isr:0x%08x\n", dev
, (u32
)status
);
445 if (0 != (isr
& (MASK_27
))) {
446 DEB_INT("irq: RPS0 (0x%08x)\n", isr
);
447 saa7146_video_uops
.irq_done(dev
,isr
);
450 if (0 != (isr
& (MASK_28
))) {
451 u32 mc2
= saa7146_read(dev
, MC2
);
452 if( 0 != (mc2
& MASK_15
)) {
453 DEB_INT("irq: RPS1 vbi workaround (0x%08x)\n", isr
);
454 wake_up(&dev
->vv_data
->vbi_wq
);
455 saa7146_write(dev
,MC2
, MASK_31
);
458 DEB_INT("irq: RPS1 (0x%08x)\n", isr
);
459 saa7146_vbi_uops
.irq_done(dev
,isr
);
463 static const struct v4l2_ctrl_ops saa7146_ctrl_ops
= {
464 .s_ctrl
= saa7146_s_ctrl
,
467 int saa7146_vv_init(struct saa7146_dev
* dev
, struct saa7146_ext_vv
*ext_vv
)
469 struct v4l2_ctrl_handler
*hdl
= &dev
->ctrl_handler
;
470 struct v4l2_pix_format
*fmt
;
471 struct v4l2_vbi_format
*vbi
;
472 struct saa7146_vv
*vv
;
475 err
= v4l2_device_register(&dev
->pci
->dev
, &dev
->v4l2_dev
);
479 v4l2_ctrl_handler_init(hdl
, 6);
480 v4l2_ctrl_new_std(hdl
, &saa7146_ctrl_ops
,
481 V4L2_CID_BRIGHTNESS
, 0, 255, 1, 128);
482 v4l2_ctrl_new_std(hdl
, &saa7146_ctrl_ops
,
483 V4L2_CID_CONTRAST
, 0, 127, 1, 64);
484 v4l2_ctrl_new_std(hdl
, &saa7146_ctrl_ops
,
485 V4L2_CID_SATURATION
, 0, 127, 1, 64);
486 v4l2_ctrl_new_std(hdl
, &saa7146_ctrl_ops
,
487 V4L2_CID_VFLIP
, 0, 1, 1, 0);
488 v4l2_ctrl_new_std(hdl
, &saa7146_ctrl_ops
,
489 V4L2_CID_HFLIP
, 0, 1, 1, 0);
492 v4l2_ctrl_handler_free(hdl
);
495 dev
->v4l2_dev
.ctrl_handler
= hdl
;
497 vv
= kzalloc(sizeof(struct saa7146_vv
), GFP_KERNEL
);
499 ERR("out of memory. aborting.\n");
500 v4l2_ctrl_handler_free(hdl
);
503 ext_vv
->vid_ops
= saa7146_video_ioctl_ops
;
504 ext_vv
->vbi_ops
= saa7146_vbi_ioctl_ops
;
505 ext_vv
->core_ops
= &saa7146_video_ioctl_ops
;
507 DEB_EE("dev:%p\n", dev
);
509 /* set default values for video parts of the saa7146 */
510 saa7146_write(dev
, BCS_CTRL
, 0x80400040);
512 /* enable video-port pins */
513 saa7146_write(dev
, MC1
, (MASK_10
| MASK_26
));
515 /* save per-device extension data (one extension can
516 handle different devices that might need different
517 configuration data) */
518 dev
->ext_vv_data
= ext_vv
;
520 vv
->d_clipping
.cpu_addr
=
521 pci_zalloc_consistent(dev
->pci
, SAA7146_CLIPPING_MEM
,
522 &vv
->d_clipping
.dma_handle
);
523 if( NULL
== vv
->d_clipping
.cpu_addr
) {
524 ERR("out of memory. aborting.\n");
526 v4l2_ctrl_handler_free(hdl
);
530 saa7146_video_uops
.init(dev
,vv
);
531 if (dev
->ext_vv_data
->capabilities
& V4L2_CAP_VBI_CAPTURE
)
532 saa7146_vbi_uops
.init(dev
,vv
);
534 vv
->ov_fb
.fmt
.width
= vv
->standard
->h_max_out
;
535 vv
->ov_fb
.fmt
.height
= vv
->standard
->v_max_out
;
536 vv
->ov_fb
.fmt
.pixelformat
= V4L2_PIX_FMT_RGB565
;
537 vv
->ov_fb
.fmt
.bytesperline
= 2 * vv
->ov_fb
.fmt
.width
;
538 vv
->ov_fb
.fmt
.sizeimage
= vv
->ov_fb
.fmt
.bytesperline
* vv
->ov_fb
.fmt
.height
;
539 vv
->ov_fb
.fmt
.colorspace
= V4L2_COLORSPACE_SRGB
;
541 fmt
= &vv
->video_fmt
;
544 fmt
->pixelformat
= V4L2_PIX_FMT_BGR24
;
545 fmt
->field
= V4L2_FIELD_ANY
;
546 fmt
->colorspace
= V4L2_COLORSPACE_SMPTE170M
;
547 fmt
->bytesperline
= 3 * fmt
->width
;
548 fmt
->sizeimage
= fmt
->bytesperline
* fmt
->height
;
551 vbi
->sampling_rate
= 27000000;
552 vbi
->offset
= 248; /* todo */
553 vbi
->samples_per_line
= 720 * 2;
554 vbi
->sample_format
= V4L2_PIX_FMT_GREY
;
556 /* fixme: this only works for PAL */
562 timer_setup(&vv
->vbi_read_timeout
, NULL
, 0);
564 vv
->ov_fb
.capability
= V4L2_FBUF_CAP_LIST_CLIPPING
;
565 vv
->ov_fb
.flags
= V4L2_FBUF_FLAG_PRIMARY
;
567 dev
->vv_callback
= &vv_callback
;
571 EXPORT_SYMBOL_GPL(saa7146_vv_init
);
573 int saa7146_vv_release(struct saa7146_dev
* dev
)
575 struct saa7146_vv
*vv
= dev
->vv_data
;
577 DEB_EE("dev:%p\n", dev
);
579 v4l2_device_unregister(&dev
->v4l2_dev
);
580 pci_free_consistent(dev
->pci
, SAA7146_CLIPPING_MEM
, vv
->d_clipping
.cpu_addr
, vv
->d_clipping
.dma_handle
);
581 v4l2_ctrl_handler_free(&dev
->ctrl_handler
);
584 dev
->vv_callback
= NULL
;
588 EXPORT_SYMBOL_GPL(saa7146_vv_release
);
590 int saa7146_register_device(struct video_device
*vfd
, struct saa7146_dev
*dev
,
591 char *name
, int type
)
596 DEB_EE("dev:%p, name:'%s', type:%d\n", dev
, name
, type
);
598 vfd
->fops
= &video_fops
;
599 if (type
== VFL_TYPE_GRABBER
)
600 vfd
->ioctl_ops
= &dev
->ext_vv_data
->vid_ops
;
602 vfd
->ioctl_ops
= &dev
->ext_vv_data
->vbi_ops
;
603 vfd
->release
= video_device_release_empty
;
604 vfd
->lock
= &dev
->v4l2_lock
;
605 vfd
->v4l2_dev
= &dev
->v4l2_dev
;
607 for (i
= 0; i
< dev
->ext_vv_data
->num_stds
; i
++)
608 vfd
->tvnorms
|= dev
->ext_vv_data
->stds
[i
].id
;
609 strscpy(vfd
->name
, name
, sizeof(vfd
->name
));
610 video_set_drvdata(vfd
, dev
);
612 err
= video_register_device(vfd
, type
, -1);
614 ERR("cannot register v4l2 device. skipping.\n");
618 pr_info("%s: registered device %s [v4l2]\n",
619 dev
->name
, video_device_node_name(vfd
));
622 EXPORT_SYMBOL_GPL(saa7146_register_device
);
624 int saa7146_unregister_device(struct video_device
*vfd
, struct saa7146_dev
*dev
)
626 DEB_EE("dev:%p\n", dev
);
628 video_unregister_device(vfd
);
631 EXPORT_SYMBOL_GPL(saa7146_unregister_device
);
633 static int __init
saa7146_vv_init_module(void)
639 static void __exit
saa7146_vv_cleanup_module(void)
643 module_init(saa7146_vv_init_module
);
644 module_exit(saa7146_vv_cleanup_module
);
646 MODULE_AUTHOR("Michael Hunold <michael@mihu.de>");
647 MODULE_DESCRIPTION("video4linux driver for saa7146-based hardware");
648 MODULE_LICENSE("GPL");