]>
Commit | Line | Data |
---|---|---|
09c434b8 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
44d0b80e JP |
2 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
3 | ||
d647f0b7 | 4 | #include <media/drv-intf/saa7146_vv.h> |
7a707b89 | 5 | #include <linux/module.h> |
1da177e4 | 6 | |
1da177e4 LT |
7 | /****************************************************************************/ |
8 | /* resource management functions, shamelessly stolen from saa7134 driver */ | |
9 | ||
10 | int saa7146_res_get(struct saa7146_fh *fh, unsigned int bit) | |
11 | { | |
12 | struct saa7146_dev *dev = fh->dev; | |
13 | struct saa7146_vv *vv = dev->vv_data; | |
14 | ||
15 | if (fh->resources & bit) { | |
44d0b80e JP |
16 | DEB_D("already allocated! want: 0x%02x, cur:0x%02x\n", |
17 | bit, vv->resources); | |
1da177e4 LT |
18 | /* have it already allocated */ |
19 | return 1; | |
20 | } | |
21 | ||
22 | /* is it free? */ | |
1da177e4 | 23 | if (vv->resources & bit) { |
44d0b80e JP |
24 | DEB_D("locked! vv->resources:0x%02x, we want:0x%02x\n", |
25 | vv->resources, bit); | |
1da177e4 | 26 | /* no, someone else uses it */ |
1da177e4 LT |
27 | return 0; |
28 | } | |
29 | /* it's free, grab it */ | |
44d0b80e | 30 | fh->resources |= bit; |
1da177e4 | 31 | vv->resources |= bit; |
44d0b80e | 32 | DEB_D("res: get 0x%02x, cur:0x%02x\n", bit, vv->resources); |
1da177e4 LT |
33 | return 1; |
34 | } | |
35 | ||
36 | void saa7146_res_free(struct saa7146_fh *fh, unsigned int bits) | |
37 | { | |
38 | struct saa7146_dev *dev = fh->dev; | |
39 | struct saa7146_vv *vv = dev->vv_data; | |
40 | ||
ae24601b | 41 | BUG_ON((fh->resources & bits) != bits); |
1da177e4 | 42 | |
44d0b80e | 43 | fh->resources &= ~bits; |
1da177e4 | 44 | vv->resources &= ~bits; |
44d0b80e | 45 | DEB_D("res: put 0x%02x, cur:0x%02x\n", bits, vv->resources); |
1da177e4 LT |
46 | } |
47 | ||
48 | ||
49 | /********************************************************************************/ | |
50 | /* common dma functions */ | |
51 | ||
c7b0ac05 MCC |
52 | void saa7146_dma_free(struct saa7146_dev *dev,struct videobuf_queue *q, |
53 | struct saa7146_buf *buf) | |
1da177e4 | 54 | { |
c1accaa2 | 55 | struct videobuf_dmabuf *dma=videobuf_to_dma(&buf->vb); |
44d0b80e | 56 | DEB_EE("dev:%p, buf:%p\n", dev, buf); |
1da177e4 | 57 | |
ae24601b | 58 | BUG_ON(in_interrupt()); |
1da177e4 | 59 | |
0e0809a5 | 60 | videobuf_waiton(q, &buf->vb, 0, 0); |
95268403 | 61 | videobuf_dma_unmap(q->dev, dma); |
c1accaa2 | 62 | videobuf_dma_free(dma); |
0fc0686e | 63 | buf->vb.state = VIDEOBUF_NEEDS_INIT; |
1da177e4 LT |
64 | } |
65 | ||
66 | ||
67 | /********************************************************************************/ | |
68 | /* common buffer functions */ | |
69 | ||
70 | int saa7146_buffer_queue(struct saa7146_dev *dev, | |
71 | struct saa7146_dmaqueue *q, | |
72 | struct saa7146_buf *buf) | |
73 | { | |
74 | assert_spin_locked(&dev->slock); | |
44d0b80e | 75 | DEB_EE("dev:%p, dmaq:%p, buf:%p\n", dev, q, buf); |
1da177e4 LT |
76 | |
77 | BUG_ON(!q); | |
78 | ||
79 | if (NULL == q->curr) { | |
80 | q->curr = buf; | |
44d0b80e | 81 | DEB_D("immediately activating buffer %p\n", buf); |
1da177e4 LT |
82 | buf->activate(dev,buf,NULL); |
83 | } else { | |
84 | list_add_tail(&buf->vb.queue,&q->queue); | |
0fc0686e | 85 | buf->vb.state = VIDEOBUF_QUEUED; |
44d0b80e JP |
86 | DEB_D("adding buffer %p to queue. (active buffer present)\n", |
87 | buf); | |
1da177e4 LT |
88 | } |
89 | return 0; | |
90 | } | |
91 | ||
92 | void saa7146_buffer_finish(struct saa7146_dev *dev, | |
93 | struct saa7146_dmaqueue *q, | |
94 | int state) | |
95 | { | |
96 | assert_spin_locked(&dev->slock); | |
44d0b80e JP |
97 | DEB_EE("dev:%p, dmaq:%p, state:%d\n", dev, q, state); |
98 | DEB_EE("q->curr:%p\n", q->curr); | |
1da177e4 LT |
99 | |
100 | BUG_ON(!q->curr); | |
101 | ||
102 | /* finish current buffer */ | |
103 | if (NULL == q->curr) { | |
44d0b80e | 104 | DEB_D("aiii. no current buffer\n"); |
afd1a0c9 | 105 | return; |
1da177e4 | 106 | } |
afd1a0c9 | 107 | |
1da177e4 | 108 | q->curr->vb.state = state; |
15a40b27 | 109 | q->curr->vb.ts = ktime_get_ns(); |
1da177e4 LT |
110 | wake_up(&q->curr->vb.done); |
111 | ||
112 | q->curr = NULL; | |
113 | } | |
114 | ||
115 | void saa7146_buffer_next(struct saa7146_dev *dev, | |
116 | struct saa7146_dmaqueue *q, int vbi) | |
117 | { | |
118 | struct saa7146_buf *buf,*next = NULL; | |
119 | ||
120 | BUG_ON(!q); | |
121 | ||
44d0b80e | 122 | DEB_INT("dev:%p, dmaq:%p, vbi:%d\n", dev, q, vbi); |
1da177e4 LT |
123 | |
124 | assert_spin_locked(&dev->slock); | |
125 | if (!list_empty(&q->queue)) { | |
126 | /* activate next one from queue */ | |
127 | buf = list_entry(q->queue.next,struct saa7146_buf,vb.queue); | |
128 | list_del(&buf->vb.queue); | |
129 | if (!list_empty(&q->queue)) | |
130 | next = list_entry(q->queue.next,struct saa7146_buf, vb.queue); | |
131 | q->curr = buf; | |
44d0b80e JP |
132 | DEB_INT("next buffer: buf:%p, prev:%p, next:%p\n", |
133 | buf, q->queue.prev, q->queue.next); | |
1da177e4 LT |
134 | buf->activate(dev,buf,next); |
135 | } else { | |
44d0b80e | 136 | DEB_INT("no next buffer. stopping.\n"); |
1da177e4 LT |
137 | if( 0 != vbi ) { |
138 | /* turn off video-dma3 */ | |
139 | saa7146_write(dev,MC1, MASK_20); | |
140 | } else { | |
141 | /* nothing to do -- just prevent next video-dma1 transfer | |
142 | by lowering the protection address */ | |
143 | ||
144 | // fixme: fix this for vflip != 0 | |
145 | ||
146 | saa7146_write(dev, PROT_ADDR1, 0); | |
afd1a0c9 | 147 | saa7146_write(dev, MC2, (MASK_02|MASK_18)); |
1da177e4 LT |
148 | |
149 | /* write the address of the rps-program */ | |
150 | saa7146_write(dev, RPS_ADDR0, dev->d_rps0.dma_handle); | |
151 | /* turn on rps */ | |
152 | saa7146_write(dev, MC1, (MASK_12 | MASK_28)); | |
afd1a0c9 | 153 | |
1da177e4 LT |
154 | /* |
155 | printk("vdma%d.base_even: 0x%08x\n", 1,saa7146_read(dev,BASE_EVEN1)); | |
156 | printk("vdma%d.base_odd: 0x%08x\n", 1,saa7146_read(dev,BASE_ODD1)); | |
157 | printk("vdma%d.prot_addr: 0x%08x\n", 1,saa7146_read(dev,PROT_ADDR1)); | |
158 | printk("vdma%d.base_page: 0x%08x\n", 1,saa7146_read(dev,BASE_PAGE1)); | |
159 | printk("vdma%d.pitch: 0x%08x\n", 1,saa7146_read(dev,PITCH1)); | |
160 | printk("vdma%d.num_line_byte: 0x%08x\n", 1,saa7146_read(dev,NUM_LINE_BYTE1)); | |
161 | */ | |
162 | } | |
163 | del_timer(&q->timeout); | |
164 | } | |
165 | } | |
166 | ||
12a83612 | 167 | void saa7146_buffer_timeout(struct timer_list *t) |
1da177e4 | 168 | { |
12a83612 | 169 | struct saa7146_dmaqueue *q = from_timer(q, t, timeout); |
1da177e4 LT |
170 | struct saa7146_dev *dev = q->dev; |
171 | unsigned long flags; | |
172 | ||
44d0b80e | 173 | DEB_EE("dev:%p, dmaq:%p\n", dev, q); |
1da177e4 LT |
174 | |
175 | spin_lock_irqsave(&dev->slock,flags); | |
176 | if (q->curr) { | |
44d0b80e | 177 | DEB_D("timeout on %p\n", q->curr); |
0fc0686e | 178 | saa7146_buffer_finish(dev,q,VIDEOBUF_ERROR); |
1da177e4 LT |
179 | } |
180 | ||
181 | /* we don't restart the transfer here like other drivers do. when | |
182 | a streaming capture is disabled, the timeout function will be | |
183 | called for the current buffer. if we activate the next buffer now, | |
184 | we mess up our capture logic. if a timeout occurs on another buffer, | |
185 | then something is seriously broken before, so no need to buffer the | |
186 | next capture IMHO... */ | |
187 | /* | |
188 | saa7146_buffer_next(dev,q); | |
189 | */ | |
190 | spin_unlock_irqrestore(&dev->slock,flags); | |
191 | } | |
192 | ||
193 | /********************************************************************************/ | |
194 | /* file operations */ | |
195 | ||
bec43661 | 196 | static int fops_open(struct file *file) |
1da177e4 | 197 | { |
63b0d5ad LP |
198 | struct video_device *vdev = video_devdata(file); |
199 | struct saa7146_dev *dev = video_drvdata(file); | |
1da177e4 LT |
200 | struct saa7146_fh *fh = NULL; |
201 | int result = 0; | |
1da177e4 | 202 | |
44d0b80e | 203 | DEB_EE("file:%p, dev:%s\n", file, video_device_node_name(vdev)); |
1da177e4 | 204 | |
6de7d14d | 205 | if (mutex_lock_interruptible(vdev->lock)) |
1da177e4 LT |
206 | return -ERESTARTSYS; |
207 | ||
44d0b80e | 208 | DEB_D("using: %p\n", dev); |
1da177e4 LT |
209 | |
210 | /* check if an extension is registered */ | |
211 | if( NULL == dev->ext ) { | |
44d0b80e | 212 | DEB_S("no extension registered for this device\n"); |
1da177e4 LT |
213 | result = -ENODEV; |
214 | goto out; | |
215 | } | |
216 | ||
217 | /* allocate per open data */ | |
7408187d | 218 | fh = kzalloc(sizeof(*fh),GFP_KERNEL); |
1da177e4 | 219 | if (NULL == fh) { |
44d0b80e | 220 | DEB_S("cannot allocate memory for per open data\n"); |
1da177e4 LT |
221 | result = -ENOMEM; |
222 | goto out; | |
223 | } | |
afd1a0c9 | 224 | |
537fa492 HV |
225 | v4l2_fh_init(&fh->fh, vdev); |
226 | ||
227 | file->private_data = &fh->fh; | |
1da177e4 | 228 | fh->dev = dev; |
1da177e4 | 229 | |
6694a560 | 230 | if (vdev->vfl_type == VFL_TYPE_VBI) { |
44d0b80e | 231 | DEB_S("initializing vbi...\n"); |
5b0fa4ff OE |
232 | if (dev->ext_vv_data->capabilities & V4L2_CAP_VBI_CAPTURE) |
233 | result = saa7146_vbi_uops.open(dev,file); | |
234 | if (dev->ext_vv_data->vbi_fops.open) | |
bec43661 | 235 | dev->ext_vv_data->vbi_fops.open(file); |
1da177e4 | 236 | } else { |
44d0b80e | 237 | DEB_S("initializing video...\n"); |
1da177e4 LT |
238 | result = saa7146_video_uops.open(dev,file); |
239 | } | |
240 | ||
241 | if (0 != result) { | |
242 | goto out; | |
243 | } | |
244 | ||
245 | if( 0 == try_module_get(dev->ext->module)) { | |
246 | result = -EINVAL; | |
247 | goto out; | |
248 | } | |
249 | ||
250 | result = 0; | |
537fa492 | 251 | v4l2_fh_add(&fh->fh); |
1da177e4 | 252 | out: |
5fa1247a | 253 | if (fh && result != 0) { |
1da177e4 LT |
254 | kfree(fh); |
255 | file->private_data = NULL; | |
256 | } | |
6de7d14d | 257 | mutex_unlock(vdev->lock); |
afd1a0c9 | 258 | return result; |
1da177e4 LT |
259 | } |
260 | ||
bec43661 | 261 | static int fops_release(struct file *file) |
1da177e4 | 262 | { |
6694a560 | 263 | struct video_device *vdev = video_devdata(file); |
1da177e4 LT |
264 | struct saa7146_fh *fh = file->private_data; |
265 | struct saa7146_dev *dev = fh->dev; | |
266 | ||
44d0b80e | 267 | DEB_EE("file:%p\n", file); |
1da177e4 | 268 | |
21a73397 | 269 | mutex_lock(vdev->lock); |
1da177e4 | 270 | |
6694a560 | 271 | if (vdev->vfl_type == VFL_TYPE_VBI) { |
5b0fa4ff OE |
272 | if (dev->ext_vv_data->capabilities & V4L2_CAP_VBI_CAPTURE) |
273 | saa7146_vbi_uops.release(dev,file); | |
274 | if (dev->ext_vv_data->vbi_fops.release) | |
bec43661 | 275 | dev->ext_vv_data->vbi_fops.release(file); |
1da177e4 LT |
276 | } else { |
277 | saa7146_video_uops.release(dev,file); | |
278 | } | |
279 | ||
537fa492 HV |
280 | v4l2_fh_del(&fh->fh); |
281 | v4l2_fh_exit(&fh->fh); | |
1da177e4 LT |
282 | module_put(dev->ext->module); |
283 | file->private_data = NULL; | |
284 | kfree(fh); | |
285 | ||
6de7d14d | 286 | mutex_unlock(vdev->lock); |
1da177e4 LT |
287 | |
288 | return 0; | |
289 | } | |
290 | ||
1da177e4 LT |
291 | static int fops_mmap(struct file *file, struct vm_area_struct * vma) |
292 | { | |
6694a560 | 293 | struct video_device *vdev = video_devdata(file); |
1da177e4 LT |
294 | struct saa7146_fh *fh = file->private_data; |
295 | struct videobuf_queue *q; | |
6de7d14d | 296 | int res; |
1da177e4 | 297 | |
6694a560 HV |
298 | switch (vdev->vfl_type) { |
299 | case VFL_TYPE_GRABBER: { | |
44d0b80e JP |
300 | DEB_EE("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, vma:%p\n", |
301 | file, vma); | |
1da177e4 LT |
302 | q = &fh->video_q; |
303 | break; | |
304 | } | |
6694a560 | 305 | case VFL_TYPE_VBI: { |
44d0b80e JP |
306 | DEB_EE("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, vma:%p\n", |
307 | file, vma); | |
a299e407 HV |
308 | if (fh->dev->ext_vv_data->capabilities & V4L2_CAP_SLICED_VBI_OUTPUT) |
309 | return -ENODEV; | |
1da177e4 LT |
310 | q = &fh->vbi_q; |
311 | break; | |
312 | } | |
313 | default: | |
314 | BUG(); | |
1da177e4 | 315 | } |
50c25fff | 316 | |
6de7d14d HV |
317 | if (mutex_lock_interruptible(vdev->lock)) |
318 | return -ERESTARTSYS; | |
319 | res = videobuf_mmap_mapper(q, vma); | |
320 | mutex_unlock(vdev->lock); | |
321 | return res; | |
1da177e4 LT |
322 | } |
323 | ||
c23e0cb8 | 324 | static __poll_t __fops_poll(struct file *file, struct poll_table_struct *wait) |
1da177e4 | 325 | { |
6694a560 | 326 | struct video_device *vdev = video_devdata(file); |
1da177e4 LT |
327 | struct saa7146_fh *fh = file->private_data; |
328 | struct videobuf_buffer *buf = NULL; | |
329 | struct videobuf_queue *q; | |
c23e0cb8 | 330 | __poll_t res = v4l2_ctrl_poll(file, wait); |
1da177e4 | 331 | |
44d0b80e | 332 | DEB_EE("file:%p, poll:%p\n", file, wait); |
1da177e4 | 333 | |
6694a560 | 334 | if (vdev->vfl_type == VFL_TYPE_VBI) { |
a299e407 | 335 | if (fh->dev->ext_vv_data->capabilities & V4L2_CAP_SLICED_VBI_OUTPUT) |
a9a08845 | 336 | return res | EPOLLOUT | EPOLLWRNORM; |
1da177e4 | 337 | if( 0 == fh->vbi_q.streaming ) |
537fa492 | 338 | return res | videobuf_poll_stream(file, &fh->vbi_q, wait); |
1da177e4 LT |
339 | q = &fh->vbi_q; |
340 | } else { | |
44d0b80e | 341 | DEB_D("using video queue\n"); |
1da177e4 LT |
342 | q = &fh->video_q; |
343 | } | |
344 | ||
345 | if (!list_empty(&q->stream)) | |
346 | buf = list_entry(q->stream.next, struct videobuf_buffer, stream); | |
347 | ||
348 | if (!buf) { | |
44d0b80e | 349 | DEB_D("buf == NULL!\n"); |
a9a08845 | 350 | return res | EPOLLERR; |
1da177e4 LT |
351 | } |
352 | ||
353 | poll_wait(file, &buf->done, wait); | |
0fc0686e | 354 | if (buf->state == VIDEOBUF_DONE || buf->state == VIDEOBUF_ERROR) { |
44d0b80e | 355 | DEB_D("poll succeeded!\n"); |
a9a08845 | 356 | return res | EPOLLIN | EPOLLRDNORM; |
1da177e4 LT |
357 | } |
358 | ||
44d0b80e | 359 | DEB_D("nothing to poll for, buf->state:%d\n", buf->state); |
537fa492 | 360 | return res; |
1da177e4 LT |
361 | } |
362 | ||
c23e0cb8 | 363 | static __poll_t fops_poll(struct file *file, struct poll_table_struct *wait) |
6de7d14d HV |
364 | { |
365 | struct video_device *vdev = video_devdata(file); | |
c23e0cb8 | 366 | __poll_t res; |
6de7d14d HV |
367 | |
368 | mutex_lock(vdev->lock); | |
369 | res = __fops_poll(file, wait); | |
370 | mutex_unlock(vdev->lock); | |
371 | return res; | |
372 | } | |
373 | ||
1da177e4 LT |
374 | static ssize_t fops_read(struct file *file, char __user *data, size_t count, loff_t *ppos) |
375 | { | |
6694a560 | 376 | struct video_device *vdev = video_devdata(file); |
1da177e4 | 377 | struct saa7146_fh *fh = file->private_data; |
6de7d14d | 378 | int ret; |
1da177e4 | 379 | |
6694a560 HV |
380 | switch (vdev->vfl_type) { |
381 | case VFL_TYPE_GRABBER: | |
44d0b80e JP |
382 | /* |
383 | DEB_EE("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, data:%p, count:%lun", | |
384 | file, data, (unsigned long)count); | |
385 | */ | |
1da177e4 | 386 | return saa7146_video_uops.read(file,data,count,ppos); |
6694a560 | 387 | case VFL_TYPE_VBI: |
44d0b80e JP |
388 | /* |
389 | DEB_EE("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, data:%p, count:%lu\n", | |
390 | file, data, (unsigned long)count); | |
391 | */ | |
6de7d14d HV |
392 | if (fh->dev->ext_vv_data->capabilities & V4L2_CAP_VBI_CAPTURE) { |
393 | if (mutex_lock_interruptible(vdev->lock)) | |
394 | return -ERESTARTSYS; | |
395 | ret = saa7146_vbi_uops.read(file, data, count, ppos); | |
396 | mutex_unlock(vdev->lock); | |
397 | return ret; | |
398 | } | |
44d0b80e | 399 | return -EINVAL; |
1da177e4 LT |
400 | default: |
401 | BUG(); | |
1da177e4 LT |
402 | } |
403 | } | |
404 | ||
5b0fa4ff OE |
405 | static ssize_t fops_write(struct file *file, const char __user *data, size_t count, loff_t *ppos) |
406 | { | |
6694a560 | 407 | struct video_device *vdev = video_devdata(file); |
5b0fa4ff | 408 | struct saa7146_fh *fh = file->private_data; |
6de7d14d | 409 | int ret; |
5b0fa4ff | 410 | |
6694a560 HV |
411 | switch (vdev->vfl_type) { |
412 | case VFL_TYPE_GRABBER: | |
5b0fa4ff | 413 | return -EINVAL; |
6694a560 | 414 | case VFL_TYPE_VBI: |
6de7d14d HV |
415 | if (fh->dev->ext_vv_data->vbi_fops.write) { |
416 | if (mutex_lock_interruptible(vdev->lock)) | |
417 | return -ERESTARTSYS; | |
418 | ret = fh->dev->ext_vv_data->vbi_fops.write(file, data, count, ppos); | |
419 | mutex_unlock(vdev->lock); | |
420 | return ret; | |
421 | } | |
422 | return -EINVAL; | |
5b0fa4ff OE |
423 | default: |
424 | BUG(); | |
5b0fa4ff OE |
425 | } |
426 | } | |
427 | ||
bec43661 | 428 | static const struct v4l2_file_operations video_fops = |
1da177e4 LT |
429 | { |
430 | .owner = THIS_MODULE, | |
431 | .open = fops_open, | |
432 | .release = fops_release, | |
433 | .read = fops_read, | |
5b0fa4ff | 434 | .write = fops_write, |
1da177e4 LT |
435 | .poll = fops_poll, |
436 | .mmap = fops_mmap, | |
9af39713 | 437 | .unlocked_ioctl = video_ioctl2, |
1da177e4 LT |
438 | }; |
439 | ||
52c1da39 | 440 | static void vv_callback(struct saa7146_dev *dev, unsigned long status) |
1da177e4 LT |
441 | { |
442 | u32 isr = status; | |
afd1a0c9 | 443 | |
44d0b80e | 444 | DEB_INT("dev:%p, isr:0x%08x\n", dev, (u32)status); |
1da177e4 LT |
445 | |
446 | if (0 != (isr & (MASK_27))) { | |
44d0b80e | 447 | DEB_INT("irq: RPS0 (0x%08x)\n", isr); |
1da177e4 LT |
448 | saa7146_video_uops.irq_done(dev,isr); |
449 | } | |
450 | ||
451 | if (0 != (isr & (MASK_28))) { | |
452 | u32 mc2 = saa7146_read(dev, MC2); | |
453 | if( 0 != (mc2 & MASK_15)) { | |
44d0b80e | 454 | DEB_INT("irq: RPS1 vbi workaround (0x%08x)\n", isr); |
1da177e4 LT |
455 | wake_up(&dev->vv_data->vbi_wq); |
456 | saa7146_write(dev,MC2, MASK_31); | |
457 | return; | |
458 | } | |
44d0b80e | 459 | DEB_INT("irq: RPS1 (0x%08x)\n", isr); |
1da177e4 LT |
460 | saa7146_vbi_uops.irq_done(dev,isr); |
461 | } | |
462 | } | |
463 | ||
6e65ca94 HV |
464 | static const struct v4l2_ctrl_ops saa7146_ctrl_ops = { |
465 | .s_ctrl = saa7146_s_ctrl, | |
466 | }; | |
467 | ||
1da177e4 LT |
468 | int saa7146_vv_init(struct saa7146_dev* dev, struct saa7146_ext_vv *ext_vv) |
469 | { | |
6e65ca94 | 470 | struct v4l2_ctrl_handler *hdl = &dev->ctrl_handler; |
5da545ad | 471 | struct v4l2_pix_format *fmt; |
fca3469a | 472 | struct v4l2_vbi_format *vbi; |
230b65f9 | 473 | struct saa7146_vv *vv; |
03b1930e HV |
474 | int err; |
475 | ||
476 | err = v4l2_device_register(&dev->pci->dev, &dev->v4l2_dev); | |
477 | if (err) | |
478 | return err; | |
230b65f9 | 479 | |
6e65ca94 HV |
480 | v4l2_ctrl_handler_init(hdl, 6); |
481 | v4l2_ctrl_new_std(hdl, &saa7146_ctrl_ops, | |
482 | V4L2_CID_BRIGHTNESS, 0, 255, 1, 128); | |
483 | v4l2_ctrl_new_std(hdl, &saa7146_ctrl_ops, | |
484 | V4L2_CID_CONTRAST, 0, 127, 1, 64); | |
485 | v4l2_ctrl_new_std(hdl, &saa7146_ctrl_ops, | |
486 | V4L2_CID_SATURATION, 0, 127, 1, 64); | |
487 | v4l2_ctrl_new_std(hdl, &saa7146_ctrl_ops, | |
488 | V4L2_CID_VFLIP, 0, 1, 1, 0); | |
489 | v4l2_ctrl_new_std(hdl, &saa7146_ctrl_ops, | |
490 | V4L2_CID_HFLIP, 0, 1, 1, 0); | |
491 | if (hdl->error) { | |
492 | err = hdl->error; | |
493 | v4l2_ctrl_handler_free(hdl); | |
494 | return err; | |
495 | } | |
496 | dev->v4l2_dev.ctrl_handler = hdl; | |
497 | ||
230b65f9 | 498 | vv = kzalloc(sizeof(struct saa7146_vv), GFP_KERNEL); |
b960074f | 499 | if (vv == NULL) { |
44d0b80e | 500 | ERR("out of memory. aborting.\n"); |
6e65ca94 | 501 | v4l2_ctrl_handler_free(hdl); |
230b65f9 | 502 | return -ENOMEM; |
1da177e4 | 503 | } |
ab49ae0f HV |
504 | ext_vv->vid_ops = saa7146_video_ioctl_ops; |
505 | ext_vv->vbi_ops = saa7146_vbi_ioctl_ops; | |
b960074f | 506 | ext_vv->core_ops = &saa7146_video_ioctl_ops; |
1da177e4 | 507 | |
44d0b80e | 508 | DEB_EE("dev:%p\n", dev); |
1da177e4 LT |
509 | |
510 | /* set default values for video parts of the saa7146 */ | |
511 | saa7146_write(dev, BCS_CTRL, 0x80400040); | |
512 | ||
513 | /* enable video-port pins */ | |
514 | saa7146_write(dev, MC1, (MASK_10 | MASK_26)); | |
515 | ||
516 | /* save per-device extension data (one extension can | |
517 | handle different devices that might need different | |
518 | configuration data) */ | |
519 | dev->ext_vv_data = ext_vv; | |
afd1a0c9 | 520 | |
6850aeab JP |
521 | vv->d_clipping.cpu_addr = |
522 | pci_zalloc_consistent(dev->pci, SAA7146_CLIPPING_MEM, | |
523 | &vv->d_clipping.dma_handle); | |
1da177e4 | 524 | if( NULL == vv->d_clipping.cpu_addr ) { |
44d0b80e | 525 | ERR("out of memory. aborting.\n"); |
1da177e4 | 526 | kfree(vv); |
6e65ca94 | 527 | v4l2_ctrl_handler_free(hdl); |
1da177e4 LT |
528 | return -1; |
529 | } | |
1da177e4 LT |
530 | |
531 | saa7146_video_uops.init(dev,vv); | |
5b0fa4ff OE |
532 | if (dev->ext_vv_data->capabilities & V4L2_CAP_VBI_CAPTURE) |
533 | saa7146_vbi_uops.init(dev,vv); | |
afd1a0c9 | 534 | |
c9adcb73 HV |
535 | vv->ov_fb.fmt.width = vv->standard->h_max_out; |
536 | vv->ov_fb.fmt.height = vv->standard->v_max_out; | |
537 | vv->ov_fb.fmt.pixelformat = V4L2_PIX_FMT_RGB565; | |
538 | vv->ov_fb.fmt.bytesperline = 2 * vv->ov_fb.fmt.width; | |
539 | vv->ov_fb.fmt.sizeimage = vv->ov_fb.fmt.bytesperline * vv->ov_fb.fmt.height; | |
540 | vv->ov_fb.fmt.colorspace = V4L2_COLORSPACE_SRGB; | |
fd74d6eb HV |
541 | |
542 | fmt = &vv->video_fmt; | |
543 | fmt->width = 384; | |
544 | fmt->height = 288; | |
545 | fmt->pixelformat = V4L2_PIX_FMT_BGR24; | |
546 | fmt->field = V4L2_FIELD_ANY; | |
547 | fmt->colorspace = V4L2_COLORSPACE_SMPTE170M; | |
548 | fmt->bytesperline = 3 * fmt->width; | |
549 | fmt->sizeimage = fmt->bytesperline * fmt->height; | |
550 | ||
fca3469a HV |
551 | vbi = &vv->vbi_fmt; |
552 | vbi->sampling_rate = 27000000; | |
553 | vbi->offset = 248; /* todo */ | |
554 | vbi->samples_per_line = 720 * 2; | |
555 | vbi->sample_format = V4L2_PIX_FMT_GREY; | |
556 | ||
557 | /* fixme: this only works for PAL */ | |
558 | vbi->start[0] = 5; | |
559 | vbi->count[0] = 16; | |
560 | vbi->start[1] = 312; | |
561 | vbi->count[1] = 16; | |
562 | ||
3e314917 | 563 | timer_setup(&vv->vbi_read_timeout, NULL, 0); |
fca3469a | 564 | |
5da545ad HV |
565 | vv->ov_fb.capability = V4L2_FBUF_CAP_LIST_CLIPPING; |
566 | vv->ov_fb.flags = V4L2_FBUF_FLAG_PRIMARY; | |
1da177e4 LT |
567 | dev->vv_data = vv; |
568 | dev->vv_callback = &vv_callback; | |
569 | ||
570 | return 0; | |
571 | } | |
5d7dc8c4 | 572 | EXPORT_SYMBOL_GPL(saa7146_vv_init); |
1da177e4 LT |
573 | |
574 | int saa7146_vv_release(struct saa7146_dev* dev) | |
575 | { | |
576 | struct saa7146_vv *vv = dev->vv_data; | |
577 | ||
44d0b80e | 578 | DEB_EE("dev:%p\n", dev); |
afd1a0c9 | 579 | |
230b65f9 | 580 | v4l2_device_unregister(&dev->v4l2_dev); |
58af0045 | 581 | pci_free_consistent(dev->pci, SAA7146_CLIPPING_MEM, vv->d_clipping.cpu_addr, vv->d_clipping.dma_handle); |
6e65ca94 | 582 | v4l2_ctrl_handler_free(&dev->ctrl_handler); |
afd1a0c9 | 583 | kfree(vv); |
1da177e4 LT |
584 | dev->vv_data = NULL; |
585 | dev->vv_callback = NULL; | |
afd1a0c9 | 586 | |
1da177e4 LT |
587 | return 0; |
588 | } | |
5d7dc8c4 | 589 | EXPORT_SYMBOL_GPL(saa7146_vv_release); |
1da177e4 | 590 | |
3ae863e0 | 591 | int saa7146_register_device(struct video_device *vfd, struct saa7146_dev *dev, |
1da177e4 LT |
592 | char *name, int type) |
593 | { | |
b960074f | 594 | int err; |
d0852ed2 | 595 | int i; |
1da177e4 | 596 | |
44d0b80e | 597 | DEB_EE("dev:%p, name:'%s', type:%d\n", dev, name, type); |
1da177e4 | 598 | |
b960074f | 599 | vfd->fops = &video_fops; |
ab49ae0f HV |
600 | if (type == VFL_TYPE_GRABBER) |
601 | vfd->ioctl_ops = &dev->ext_vv_data->vid_ops; | |
602 | else | |
603 | vfd->ioctl_ops = &dev->ext_vv_data->vbi_ops; | |
3ae863e0 | 604 | vfd->release = video_device_release_empty; |
9af39713 | 605 | vfd->lock = &dev->v4l2_lock; |
6e65ca94 | 606 | vfd->v4l2_dev = &dev->v4l2_dev; |
d0852ed2 HV |
607 | vfd->tvnorms = 0; |
608 | for (i = 0; i < dev->ext_vv_data->num_stds; i++) | |
609 | vfd->tvnorms |= dev->ext_vv_data->stds[i].id; | |
c0decac1 | 610 | strscpy(vfd->name, name, sizeof(vfd->name)); |
601e9444 | 611 | video_set_drvdata(vfd, dev); |
1da177e4 | 612 | |
b960074f HV |
613 | err = video_register_device(vfd, type, -1); |
614 | if (err < 0) { | |
44d0b80e | 615 | ERR("cannot register v4l2 device. skipping.\n"); |
b960074f | 616 | return err; |
1da177e4 LT |
617 | } |
618 | ||
44d0b80e JP |
619 | pr_info("%s: registered device %s [v4l2]\n", |
620 | dev->name, video_device_node_name(vfd)); | |
1da177e4 LT |
621 | return 0; |
622 | } | |
5d7dc8c4 | 623 | EXPORT_SYMBOL_GPL(saa7146_register_device); |
1da177e4 | 624 | |
3ae863e0 | 625 | int saa7146_unregister_device(struct video_device *vfd, struct saa7146_dev *dev) |
1da177e4 | 626 | { |
44d0b80e | 627 | DEB_EE("dev:%p\n", dev); |
1da177e4 | 628 | |
3ae863e0 | 629 | video_unregister_device(vfd); |
1da177e4 LT |
630 | return 0; |
631 | } | |
5d7dc8c4 | 632 | EXPORT_SYMBOL_GPL(saa7146_unregister_device); |
1da177e4 LT |
633 | |
634 | static int __init saa7146_vv_init_module(void) | |
635 | { | |
636 | return 0; | |
637 | } | |
638 | ||
639 | ||
640 | static void __exit saa7146_vv_cleanup_module(void) | |
641 | { | |
642 | } | |
643 | ||
644 | module_init(saa7146_vv_init_module); | |
645 | module_exit(saa7146_vv_cleanup_module); | |
646 | ||
647 | MODULE_AUTHOR("Michael Hunold <michael@mihu.de>"); | |
648 | MODULE_DESCRIPTION("video4linux driver for saa7146-based hardware"); | |
649 | MODULE_LICENSE("GPL"); |