1#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
2
3#include <media/drv-intf/saa7146_vv.h>
4#include <linux/module.h>
5
6
7
8
9int saa7146_res_get(struct saa7146_fh *fh, unsigned int bit)
10{
11 struct saa7146_dev *dev = fh->dev;
12 struct saa7146_vv *vv = dev->vv_data;
13
14 if (fh->resources & bit) {
15 DEB_D("already allocated! want: 0x%02x, cur:0x%02x\n",
16 bit, vv->resources);
17
18 return 1;
19 }
20
21
22 if (vv->resources & bit) {
23 DEB_D("locked! vv->resources:0x%02x, we want:0x%02x\n",
24 vv->resources, bit);
25
26 return 0;
27 }
28
29 fh->resources |= bit;
30 vv->resources |= bit;
31 DEB_D("res: get 0x%02x, cur:0x%02x\n", bit, vv->resources);
32 return 1;
33}
34
35void saa7146_res_free(struct saa7146_fh *fh, unsigned int bits)
36{
37 struct saa7146_dev *dev = fh->dev;
38 struct saa7146_vv *vv = dev->vv_data;
39
40 BUG_ON((fh->resources & bits) != bits);
41
42 fh->resources &= ~bits;
43 vv->resources &= ~bits;
44 DEB_D("res: put 0x%02x, cur:0x%02x\n", bits, vv->resources);
45}
46
47
48
49
50
51void saa7146_dma_free(struct saa7146_dev *dev,struct videobuf_queue *q,
52 struct saa7146_buf *buf)
53{
54 struct videobuf_dmabuf *dma=videobuf_to_dma(&buf->vb);
55 DEB_EE("dev:%p, buf:%p\n", dev, buf);
56
57 BUG_ON(in_interrupt());
58
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;
63}
64
65
66
67
68
69int saa7146_buffer_queue(struct saa7146_dev *dev,
70 struct saa7146_dmaqueue *q,
71 struct saa7146_buf *buf)
72{
73 assert_spin_locked(&dev->slock);
74 DEB_EE("dev:%p, dmaq:%p, buf:%p\n", dev, q, buf);
75
76 BUG_ON(!q);
77
78 if (NULL == q->curr) {
79 q->curr = buf;
80 DEB_D("immediately activating buffer %p\n", buf);
81 buf->activate(dev,buf,NULL);
82 } else {
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",
86 buf);
87 }
88 return 0;
89}
90
91void saa7146_buffer_finish(struct saa7146_dev *dev,
92 struct saa7146_dmaqueue *q,
93 int state)
94{
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);
98
99 BUG_ON(!q->curr);
100
101
102 if (NULL == q->curr) {
103 DEB_D("aiii. no current buffer\n");
104 return;
105 }
106
107 q->curr->vb.state = state;
108 v4l2_get_timestamp(&q->curr->vb.ts);
109 wake_up(&q->curr->vb.done);
110
111 q->curr = NULL;
112}
113
114void saa7146_buffer_next(struct saa7146_dev *dev,
115 struct saa7146_dmaqueue *q, int vbi)
116{
117 struct saa7146_buf *buf,*next = NULL;
118
119 BUG_ON(!q);
120
121 DEB_INT("dev:%p, dmaq:%p, vbi:%d\n", dev, q, vbi);
122
123 assert_spin_locked(&dev->slock);
124 if (!list_empty(&q->queue)) {
125
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);
130 q->curr = buf;
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);
134 } else {
135 DEB_INT("no next buffer. stopping.\n");
136 if( 0 != vbi ) {
137
138 saa7146_write(dev,MC1, MASK_20);
139 } else {
140
141
142
143
144
145 saa7146_write(dev, PROT_ADDR1, 0);
146 saa7146_write(dev, MC2, (MASK_02|MASK_18));
147
148
149 saa7146_write(dev, RPS_ADDR0, dev->d_rps0.dma_handle);
150
151 saa7146_write(dev, MC1, (MASK_12 | MASK_28));
152
153
154
155
156
157
158
159
160
161 }
162 del_timer(&q->timeout);
163 }
164}
165
166void saa7146_buffer_timeout(struct timer_list *t)
167{
168 struct saa7146_dmaqueue *q = from_timer(q, t, timeout);
169 struct saa7146_dev *dev = q->dev;
170 unsigned long flags;
171
172 DEB_EE("dev:%p, dmaq:%p\n", dev, q);
173
174 spin_lock_irqsave(&dev->slock,flags);
175 if (q->curr) {
176 DEB_D("timeout on %p\n", q->curr);
177 saa7146_buffer_finish(dev,q,VIDEOBUF_ERROR);
178 }
179
180
181
182
183
184
185
186
187
188
189 spin_unlock_irqrestore(&dev->slock,flags);
190}
191
192
193
194
195static int fops_open(struct file *file)
196{
197 struct video_device *vdev = video_devdata(file);
198 struct saa7146_dev *dev = video_drvdata(file);
199 struct saa7146_fh *fh = NULL;
200 int result = 0;
201
202 DEB_EE("file:%p, dev:%s\n", file, video_device_node_name(vdev));
203
204 if (mutex_lock_interruptible(vdev->lock))
205 return -ERESTARTSYS;
206
207 DEB_D("using: %p\n", dev);
208
209
210 if( NULL == dev->ext ) {
211 DEB_S("no extension registered for this device\n");
212 result = -ENODEV;
213 goto out;
214 }
215
216
217 fh = kzalloc(sizeof(*fh),GFP_KERNEL);
218 if (NULL == fh) {
219 DEB_S("cannot allocate memory for per open data\n");
220 result = -ENOMEM;
221 goto out;
222 }
223
224 v4l2_fh_init(&fh->fh, vdev);
225
226 file->private_data = &fh->fh;
227 fh->dev = dev;
228
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);
235 } else {
236 DEB_S("initializing video...\n");
237 result = saa7146_video_uops.open(dev,file);
238 }
239
240 if (0 != result) {
241 goto out;
242 }
243
244 if( 0 == try_module_get(dev->ext->module)) {
245 result = -EINVAL;
246 goto out;
247 }
248
249 result = 0;
250 v4l2_fh_add(&fh->fh);
251out:
252 if (fh && result != 0) {
253 kfree(fh);
254 file->private_data = NULL;
255 }
256 mutex_unlock(vdev->lock);
257 return result;
258}
259
260static int fops_release(struct file *file)
261{
262 struct video_device *vdev = video_devdata(file);
263 struct saa7146_fh *fh = file->private_data;
264 struct saa7146_dev *dev = fh->dev;
265
266 DEB_EE("file:%p\n", file);
267
268 mutex_lock(vdev->lock);
269
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);
275 } else {
276 saa7146_video_uops.release(dev,file);
277 }
278
279 v4l2_fh_del(&fh->fh);
280 v4l2_fh_exit(&fh->fh);
281 module_put(dev->ext->module);
282 file->private_data = NULL;
283 kfree(fh);
284
285 mutex_unlock(vdev->lock);
286
287 return 0;
288}
289
290static int fops_mmap(struct file *file, struct vm_area_struct * vma)
291{
292 struct video_device *vdev = video_devdata(file);
293 struct saa7146_fh *fh = file->private_data;
294 struct videobuf_queue *q;
295 int res;
296
297 switch (vdev->vfl_type) {
298 case VFL_TYPE_GRABBER: {
299 DEB_EE("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, vma:%p\n",
300 file, vma);
301 q = &fh->video_q;
302 break;
303 }
304 case VFL_TYPE_VBI: {
305 DEB_EE("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, vma:%p\n",
306 file, vma);
307 if (fh->dev->ext_vv_data->capabilities & V4L2_CAP_SLICED_VBI_OUTPUT)
308 return -ENODEV;
309 q = &fh->vbi_q;
310 break;
311 }
312 default:
313 BUG();
314 }
315
316 if (mutex_lock_interruptible(vdev->lock))
317 return -ERESTARTSYS;
318 res = videobuf_mmap_mapper(q, vma);
319 mutex_unlock(vdev->lock);
320 return res;
321}
322
323static __poll_t __fops_poll(struct file *file, struct poll_table_struct *wait)
324{
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);
330
331 DEB_EE("file:%p, poll:%p\n", file, wait);
332
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);
338 q = &fh->vbi_q;
339 } else {
340 DEB_D("using video queue\n");
341 q = &fh->video_q;
342 }
343
344 if (!list_empty(&q->stream))
345 buf = list_entry(q->stream.next, struct videobuf_buffer, stream);
346
347 if (!buf) {
348 DEB_D("buf == NULL!\n");
349 return res | EPOLLERR;
350 }
351
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;
356 }
357
358 DEB_D("nothing to poll for, buf->state:%d\n", buf->state);
359 return res;
360}
361
362static __poll_t fops_poll(struct file *file, struct poll_table_struct *wait)
363{
364 struct video_device *vdev = video_devdata(file);
365 __poll_t res;
366
367 mutex_lock(vdev->lock);
368 res = __fops_poll(file, wait);
369 mutex_unlock(vdev->lock);
370 return res;
371}
372
373static ssize_t fops_read(struct file *file, char __user *data, size_t count, loff_t *ppos)
374{
375 struct video_device *vdev = video_devdata(file);
376 struct saa7146_fh *fh = file->private_data;
377 int ret;
378
379 switch (vdev->vfl_type) {
380 case VFL_TYPE_GRABBER:
381
382
383
384
385 return saa7146_video_uops.read(file,data,count,ppos);
386 case VFL_TYPE_VBI:
387
388
389
390
391 if (fh->dev->ext_vv_data->capabilities & V4L2_CAP_VBI_CAPTURE) {
392 if (mutex_lock_interruptible(vdev->lock))
393 return -ERESTARTSYS;
394 ret = saa7146_vbi_uops.read(file, data, count, ppos);
395 mutex_unlock(vdev->lock);
396 return ret;
397 }
398 return -EINVAL;
399 default:
400 BUG();
401 }
402}
403
404static ssize_t fops_write(struct file *file, const char __user *data, size_t count, loff_t *ppos)
405{
406 struct video_device *vdev = video_devdata(file);
407 struct saa7146_fh *fh = file->private_data;
408 int ret;
409
410 switch (vdev->vfl_type) {
411 case VFL_TYPE_GRABBER:
412 return -EINVAL;
413 case VFL_TYPE_VBI:
414 if (fh->dev->ext_vv_data->vbi_fops.write) {
415 if (mutex_lock_interruptible(vdev->lock))
416 return -ERESTARTSYS;
417 ret = fh->dev->ext_vv_data->vbi_fops.write(file, data, count, ppos);
418 mutex_unlock(vdev->lock);
419 return ret;
420 }
421 return -EINVAL;
422 default:
423 BUG();
424 }
425}
426
427static const struct v4l2_file_operations video_fops =
428{
429 .owner = THIS_MODULE,
430 .open = fops_open,
431 .release = fops_release,
432 .read = fops_read,
433 .write = fops_write,
434 .poll = fops_poll,
435 .mmap = fops_mmap,
436 .unlocked_ioctl = video_ioctl2,
437};
438
439static void vv_callback(struct saa7146_dev *dev, unsigned long status)
440{
441 u32 isr = status;
442
443 DEB_INT("dev:%p, isr:0x%08x\n", dev, (u32)status);
444
445 if (0 != (isr & (MASK_27))) {
446 DEB_INT("irq: RPS0 (0x%08x)\n", isr);
447 saa7146_video_uops.irq_done(dev,isr);
448 }
449
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);
456 return;
457 }
458 DEB_INT("irq: RPS1 (0x%08x)\n", isr);
459 saa7146_vbi_uops.irq_done(dev,isr);
460 }
461}
462
463static const struct v4l2_ctrl_ops saa7146_ctrl_ops = {
464 .s_ctrl = saa7146_s_ctrl,
465};
466
467int saa7146_vv_init(struct saa7146_dev* dev, struct saa7146_ext_vv *ext_vv)
468{
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;
473 int err;
474
475 err = v4l2_device_register(&dev->pci->dev, &dev->v4l2_dev);
476 if (err)
477 return err;
478
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);
490 if (hdl->error) {
491 err = hdl->error;
492 v4l2_ctrl_handler_free(hdl);
493 return err;
494 }
495 dev->v4l2_dev.ctrl_handler = hdl;
496
497 vv = kzalloc(sizeof(struct saa7146_vv), GFP_KERNEL);
498 if (vv == NULL) {
499 ERR("out of memory. aborting.\n");
500 v4l2_ctrl_handler_free(hdl);
501 return -ENOMEM;
502 }
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;
506
507 DEB_EE("dev:%p\n", dev);
508
509
510 saa7146_write(dev, BCS_CTRL, 0x80400040);
511
512
513 saa7146_write(dev, MC1, (MASK_10 | MASK_26));
514
515
516
517
518 dev->ext_vv_data = ext_vv;
519
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");
525 kfree(vv);
526 v4l2_ctrl_handler_free(hdl);
527 return -1;
528 }
529
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);
533
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;
540
541 fmt = &vv->video_fmt;
542 fmt->width = 384;
543 fmt->height = 288;
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;
549
550 vbi = &vv->vbi_fmt;
551 vbi->sampling_rate = 27000000;
552 vbi->offset = 248;
553 vbi->samples_per_line = 720 * 2;
554 vbi->sample_format = V4L2_PIX_FMT_GREY;
555
556
557 vbi->start[0] = 5;
558 vbi->count[0] = 16;
559 vbi->start[1] = 312;
560 vbi->count[1] = 16;
561
562 timer_setup(&vv->vbi_read_timeout, NULL, 0);
563
564 vv->ov_fb.capability = V4L2_FBUF_CAP_LIST_CLIPPING;
565 vv->ov_fb.flags = V4L2_FBUF_FLAG_PRIMARY;
566 dev->vv_data = vv;
567 dev->vv_callback = &vv_callback;
568
569 return 0;
570}
571EXPORT_SYMBOL_GPL(saa7146_vv_init);
572
573int saa7146_vv_release(struct saa7146_dev* dev)
574{
575 struct saa7146_vv *vv = dev->vv_data;
576
577 DEB_EE("dev:%p\n", dev);
578
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);
582 kfree(vv);
583 dev->vv_data = NULL;
584 dev->vv_callback = NULL;
585
586 return 0;
587}
588EXPORT_SYMBOL_GPL(saa7146_vv_release);
589
590int saa7146_register_device(struct video_device *vfd, struct saa7146_dev *dev,
591 char *name, int type)
592{
593 int err;
594 int i;
595
596 DEB_EE("dev:%p, name:'%s', type:%d\n", dev, name, type);
597
598 vfd->fops = &video_fops;
599 if (type == VFL_TYPE_GRABBER)
600 vfd->ioctl_ops = &dev->ext_vv_data->vid_ops;
601 else
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;
606 vfd->tvnorms = 0;
607 for (i = 0; i < dev->ext_vv_data->num_stds; i++)
608 vfd->tvnorms |= dev->ext_vv_data->stds[i].id;
609 strlcpy(vfd->name, name, sizeof(vfd->name));
610 video_set_drvdata(vfd, dev);
611
612 err = video_register_device(vfd, type, -1);
613 if (err < 0) {
614 ERR("cannot register v4l2 device. skipping.\n");
615 return err;
616 }
617
618 pr_info("%s: registered device %s [v4l2]\n",
619 dev->name, video_device_node_name(vfd));
620 return 0;
621}
622EXPORT_SYMBOL_GPL(saa7146_register_device);
623
624int saa7146_unregister_device(struct video_device *vfd, struct saa7146_dev *dev)
625{
626 DEB_EE("dev:%p\n", dev);
627
628 video_unregister_device(vfd);
629 return 0;
630}
631EXPORT_SYMBOL_GPL(saa7146_unregister_device);
632
633static int __init saa7146_vv_init_module(void)
634{
635 return 0;
636}
637
638
639static void __exit saa7146_vv_cleanup_module(void)
640{
641}
642
643module_init(saa7146_vv_init_module);
644module_exit(saa7146_vv_cleanup_module);
645
646MODULE_AUTHOR("Michael Hunold <michael@mihu.de>");
647MODULE_DESCRIPTION("video4linux driver for saa7146-based hardware");
648MODULE_LICENSE("GPL");
649
