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 /* resource management functions, shamelessly stolen from saa7134 driver */
8 
saa7146_res_get(struct saa7146_fh * fh,unsigned int bit)9 int 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 		/* have it already allocated */
18 		return 1;
19 	}
20 
21 	/* is it free? */
22 	if (vv->resources & bit) {
23 		DEB_D("locked! vv->resources:0x%02x, we want:0x%02x\n",
24 		      vv->resources, bit);
25 		/* no, someone else uses it */
26 		return 0;
27 	}
28 	/* it's free, grab it */
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 
saa7146_res_free(struct saa7146_fh * fh,unsigned int bits)35 void 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 /* common dma functions */
50 
saa7146_dma_free(struct saa7146_dev * dev,struct videobuf_queue * q,struct saa7146_buf * buf)51 void 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 /* common buffer functions */
68 
saa7146_buffer_queue(struct saa7146_dev * dev,struct saa7146_dmaqueue * q,struct saa7146_buf * buf)69 int 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 
saa7146_buffer_finish(struct saa7146_dev * dev,struct saa7146_dmaqueue * q,int state)91 void 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 	/* finish current buffer */
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 
saa7146_buffer_next(struct saa7146_dev * dev,struct saa7146_dmaqueue * q,int vbi)114 void 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 		/* 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);
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 			/* turn off video-dma3 */
138 			saa7146_write(dev,MC1, MASK_20);
139 		} else {
140 			/* nothing to do -- just prevent next video-dma1 transfer
141 			   by lowering the protection address */
142 
143 			// fixme: fix this for vflip != 0
144 
145 			saa7146_write(dev, PROT_ADDR1, 0);
146 			saa7146_write(dev, MC2, (MASK_02|MASK_18));
147 
148 			/* write the address of the rps-program */
149 			saa7146_write(dev, RPS_ADDR0, dev->d_rps0.dma_handle);
150 			/* turn on rps */
151 			saa7146_write(dev, MC1, (MASK_12 | MASK_28));
152 
153 /*
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));
160 */
161 		}
162 		del_timer(&q->timeout);
163 	}
164 }
165 
saa7146_buffer_timeout(struct timer_list * t)166 void 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 	/* 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... */
186 /*
187 	saa7146_buffer_next(dev,q);
188 */
189 	spin_unlock_irqrestore(&dev->slock,flags);
190 }
191 
192 /********************************************************************************/
193 /* file operations */
194 
fops_open(struct file * file)195 static 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 	/* check if an extension is registered */
210 	if( NULL == dev->ext ) {
211 		DEB_S("no extension registered for this device\n");
212 		result = -ENODEV;
213 		goto out;
214 	}
215 
216 	/* allocate per open data */
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);
251 out:
252 	if (fh && result != 0) {
253 		kfree(fh);
254 		file->private_data = NULL;
255 	}
256 	mutex_unlock(vdev->lock);
257 	return result;
258 }
259 
fops_release(struct file * file)260 static 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 
fops_mmap(struct file * file,struct vm_area_struct * vma)290 static 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 
__fops_poll(struct file * file,struct poll_table_struct * wait)323 static __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 
fops_poll(struct file * file,struct poll_table_struct * wait)362 static __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 
fops_read(struct file * file,char __user * data,size_t count,loff_t * ppos)373 static 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 		DEB_EE("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, data:%p, count:%lun",
383 		       file, data, (unsigned long)count);
384 */
385 		return saa7146_video_uops.read(file,data,count,ppos);
386 	case VFL_TYPE_VBI:
387 /*
388 		DEB_EE("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, data:%p, count:%lu\n",
389 		       file, data, (unsigned long)count);
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 
fops_write(struct file * file,const char __user * data,size_t count,loff_t * ppos)404 static 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 
427 static 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 
vv_callback(struct saa7146_dev * dev,unsigned long status)439 static 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 
463 static const struct v4l2_ctrl_ops saa7146_ctrl_ops = {
464 	.s_ctrl = saa7146_s_ctrl,
465 };
466 
saa7146_vv_init(struct saa7146_dev * dev,struct saa7146_ext_vv * ext_vv)467 int 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 	/* set default values for video parts of the saa7146 */
510 	saa7146_write(dev, BCS_CTRL, 0x80400040);
511 
512 	/* enable video-port pins */
513 	saa7146_write(dev, MC1, (MASK_10 | MASK_26));
514 
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;
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 -ENOMEM;
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; /* todo */
553 	vbi->samples_per_line	= 720 * 2;
554 	vbi->sample_format	= V4L2_PIX_FMT_GREY;
555 
556 	/* fixme: this only works for PAL */
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 }
571 EXPORT_SYMBOL_GPL(saa7146_vv_init);
572 
saa7146_vv_release(struct saa7146_dev * dev)573 int 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 }
588 EXPORT_SYMBOL_GPL(saa7146_vv_release);
589 
saa7146_register_device(struct video_device * vfd,struct saa7146_dev * dev,char * name,int type)590 int 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 }
622 EXPORT_SYMBOL_GPL(saa7146_register_device);
623 
saa7146_unregister_device(struct video_device * vfd,struct saa7146_dev * dev)624 int 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 }
631 EXPORT_SYMBOL_GPL(saa7146_unregister_device);
632 
saa7146_vv_init_module(void)633 static int __init saa7146_vv_init_module(void)
634 {
635 	return 0;
636 }
637 
638 
saa7146_vv_cleanup_module(void)639 static void __exit saa7146_vv_cleanup_module(void)
640 {
641 }
642 
643 module_init(saa7146_vv_init_module);
644 module_exit(saa7146_vv_cleanup_module);
645 
646 MODULE_AUTHOR("Michael Hunold <michael@mihu.de>");
647 MODULE_DESCRIPTION("video4linux driver for saa7146-based hardware");
648 MODULE_LICENSE("GPL");
649