Commit | Line | Data |
---|---|---|
44d0b80e JP |
1 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
2 | ||
d647f0b7 | 3 | #include <media/drv-intf/saa7146_vv.h> |
7a707b89 | 4 | #include <linux/module.h> |
1da177e4 | 5 | |
1da177e4 LT |
6 | /****************************************************************************/ |
7 | /* resource management functions, shamelessly stolen from saa7134 driver */ | |
8 | ||
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) { | |
44d0b80e JP |
15 | DEB_D("already allocated! want: 0x%02x, cur:0x%02x\n", |
16 | bit, vv->resources); | |
1da177e4 LT |
17 | /* have it already allocated */ |
18 | return 1; | |
19 | } | |
20 | ||
21 | /* is it free? */ | |
1da177e4 | 22 | if (vv->resources & bit) { |
44d0b80e JP |
23 | DEB_D("locked! vv->resources:0x%02x, we want:0x%02x\n", |
24 | vv->resources, bit); | |
1da177e4 | 25 | /* no, someone else uses it */ |
1da177e4 LT |
26 | return 0; |
27 | } | |
28 | /* it's free, grab it */ | |
44d0b80e | 29 | fh->resources |= bit; |
1da177e4 | 30 | vv->resources |= bit; |
44d0b80e | 31 | DEB_D("res: get 0x%02x, cur:0x%02x\n", bit, vv->resources); |
1da177e4 LT |
32 | return 1; |
33 | } | |
34 | ||
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 | ||
ae24601b | 40 | BUG_ON((fh->resources & bits) != bits); |
1da177e4 | 41 | |
44d0b80e | 42 | fh->resources &= ~bits; |
1da177e4 | 43 | vv->resources &= ~bits; |
44d0b80e | 44 | DEB_D("res: put 0x%02x, cur:0x%02x\n", bits, vv->resources); |
1da177e4 LT |
45 | } |
46 | ||
47 | ||
48 | /********************************************************************************/ | |
49 | /* common dma functions */ | |
50 | ||
c7b0ac05 MCC |
51 | void saa7146_dma_free(struct saa7146_dev *dev,struct videobuf_queue *q, |
52 | struct saa7146_buf *buf) | |
1da177e4 | 53 | { |
c1accaa2 | 54 | struct videobuf_dmabuf *dma=videobuf_to_dma(&buf->vb); |
44d0b80e | 55 | DEB_EE("dev:%p, buf:%p\n", dev, buf); |
1da177e4 | 56 | |
ae24601b | 57 | BUG_ON(in_interrupt()); |
1da177e4 | 58 | |
0e0809a5 | 59 | videobuf_waiton(q, &buf->vb, 0, 0); |
95268403 | 60 | videobuf_dma_unmap(q->dev, dma); |
c1accaa2 | 61 | videobuf_dma_free(dma); |
0fc0686e | 62 | buf->vb.state = VIDEOBUF_NEEDS_INIT; |
1da177e4 LT |
63 | } |
64 | ||
65 | ||
66 | /********************************************************************************/ | |
67 | /* common buffer functions */ | |
68 | ||
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); | |
44d0b80e | 74 | DEB_EE("dev:%p, dmaq:%p, buf:%p\n", dev, q, buf); |
1da177e4 LT |
75 | |
76 | BUG_ON(!q); | |
77 | ||
78 | if (NULL == q->curr) { | |
79 | q->curr = buf; | |
44d0b80e | 80 | DEB_D("immediately activating buffer %p\n", buf); |
1da177e4 LT |
81 | buf->activate(dev,buf,NULL); |
82 | } else { | |
83 | list_add_tail(&buf->vb.queue,&q->queue); | |
0fc0686e | 84 | buf->vb.state = VIDEOBUF_QUEUED; |
44d0b80e JP |
85 | DEB_D("adding buffer %p to queue. (active buffer present)\n", |
86 | buf); | |
1da177e4 LT |
87 | } |
88 | return 0; | |
89 | } | |
90 | ||
91 | void saa7146_buffer_finish(struct saa7146_dev *dev, | |
92 | struct saa7146_dmaqueue *q, | |
93 | int state) | |
94 | { | |
95 | assert_spin_locked(&dev->slock); | |
44d0b80e JP |
96 | DEB_EE("dev:%p, dmaq:%p, state:%d\n", dev, q, state); |
97 | DEB_EE("q->curr:%p\n", q->curr); | |
1da177e4 LT |
98 | |
99 | BUG_ON(!q->curr); | |
100 | ||
101 | /* finish current buffer */ | |
102 | if (NULL == q->curr) { | |
44d0b80e | 103 | DEB_D("aiii. no current buffer\n"); |
afd1a0c9 | 104 | return; |
1da177e4 | 105 | } |
afd1a0c9 | 106 | |
1da177e4 | 107 | q->curr->vb.state = state; |
8e6057b5 | 108 | v4l2_get_timestamp(&q->curr->vb.ts); |
1da177e4 LT |
109 | wake_up(&q->curr->vb.done); |
110 | ||
111 | q->curr = NULL; | |
112 | } | |
113 | ||
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 | ||
44d0b80e | 121 | DEB_INT("dev:%p, dmaq:%p, vbi:%d\n", dev, q, vbi); |
1da177e4 LT |
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; | |
44d0b80e JP |
131 | DEB_INT("next buffer: buf:%p, prev:%p, next:%p\n", |
132 | buf, q->queue.prev, q->queue.next); | |
1da177e4 LT |
133 | buf->activate(dev,buf,next); |
134 | } else { | |
44d0b80e | 135 | DEB_INT("no next buffer. stopping.\n"); |
1da177e4 LT |
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); | |
afd1a0c9 | 146 | saa7146_write(dev, MC2, (MASK_02|MASK_18)); |
1da177e4 LT |
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)); | |
afd1a0c9 | 152 | |
1da177e4 LT |
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 | ||
12a83612 | 166 | void saa7146_buffer_timeout(struct timer_list *t) |
1da177e4 | 167 | { |
12a83612 | 168 | struct saa7146_dmaqueue *q = from_timer(q, t, timeout); |
1da177e4 LT |
169 | struct saa7146_dev *dev = q->dev; |
170 | unsigned long flags; | |
171 | ||
44d0b80e | 172 | DEB_EE("dev:%p, dmaq:%p\n", dev, q); |
1da177e4 LT |
173 | |
174 | spin_lock_irqsave(&dev->slock,flags); | |
175 | if (q->curr) { | |
44d0b80e | 176 | DEB_D("timeout on %p\n", q->curr); |
0fc0686e | 177 | saa7146_buffer_finish(dev,q,VIDEOBUF_ERROR); |
1da177e4 LT |
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 | ||
bec43661 | 195 | static int fops_open(struct file *file) |
1da177e4 | 196 | { |
63b0d5ad LP |
197 | struct video_device *vdev = video_devdata(file); |
198 | struct saa7146_dev *dev = video_drvdata(file); | |
1da177e4 LT |
199 | struct saa7146_fh *fh = NULL; |
200 | int result = 0; | |
1da177e4 | 201 | |
44d0b80e | 202 | DEB_EE("file:%p, dev:%s\n", file, video_device_node_name(vdev)); |
1da177e4 | 203 | |
6de7d14d | 204 | if (mutex_lock_interruptible(vdev->lock)) |
1da177e4 LT |
205 | return -ERESTARTSYS; |
206 | ||
44d0b80e | 207 | DEB_D("using: %p\n", dev); |
1da177e4 LT |
208 | |
209 | /* check if an extension is registered */ | |
210 | if( NULL == dev->ext ) { | |
44d0b80e | 211 | DEB_S("no extension registered for this device\n"); |
1da177e4 LT |
212 | result = -ENODEV; |
213 | goto out; | |
214 | } | |
215 | ||
216 | /* allocate per open data */ | |
7408187d | 217 | fh = kzalloc(sizeof(*fh),GFP_KERNEL); |
1da177e4 | 218 | if (NULL == fh) { |
44d0b80e | 219 | DEB_S("cannot allocate memory for per open data\n"); |
1da177e4 LT |
220 | result = -ENOMEM; |
221 | goto out; | |
222 | } | |
afd1a0c9 | 223 | |
537fa492 HV |
224 | v4l2_fh_init(&fh->fh, vdev); |
225 | ||
226 | file->private_data = &fh->fh; | |
1da177e4 | 227 | fh->dev = dev; |
1da177e4 | 228 | |
6694a560 | 229 | if (vdev->vfl_type == VFL_TYPE_VBI) { |
44d0b80e | 230 | DEB_S("initializing vbi...\n"); |
5b0fa4ff OE |
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) | |
bec43661 | 234 | dev->ext_vv_data->vbi_fops.open(file); |
1da177e4 | 235 | } else { |
44d0b80e | 236 | DEB_S("initializing video...\n"); |
1da177e4 LT |
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; | |
537fa492 | 250 | v4l2_fh_add(&fh->fh); |
1da177e4 | 251 | out: |
5fa1247a | 252 | if (fh && result != 0) { |
1da177e4 LT |
253 | kfree(fh); |
254 | file->private_data = NULL; | |
255 | } | |
6de7d14d | 256 | mutex_unlock(vdev->lock); |
afd1a0c9 | 257 | return result; |
1da177e4 LT |
258 | } |
259 | ||
bec43661 | 260 | static int fops_release(struct file *file) |
1da177e4 | 261 | { |
6694a560 | 262 | struct video_device *vdev = video_devdata(file); |
1da177e4 LT |
263 | struct saa7146_fh *fh = file->private_data; |
264 | struct saa7146_dev *dev = fh->dev; | |
265 | ||
44d0b80e | 266 | DEB_EE("file:%p\n", file); |
1da177e4 | 267 | |
21a73397 | 268 | mutex_lock(vdev->lock); |
1da177e4 | 269 | |
6694a560 | 270 | if (vdev->vfl_type == VFL_TYPE_VBI) { |
5b0fa4ff OE |
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) | |
bec43661 | 274 | dev->ext_vv_data->vbi_fops.release(file); |
1da177e4 LT |
275 | } else { |
276 | saa7146_video_uops.release(dev,file); | |
277 | } | |
278 | ||
537fa492 HV |
279 | v4l2_fh_del(&fh->fh); |
280 | v4l2_fh_exit(&fh->fh); | |
1da177e4 LT |
281 | module_put(dev->ext->module); |
282 | file->private_data = NULL; | |
283 | kfree(fh); | |
284 | ||
6de7d14d | 285 | mutex_unlock(vdev->lock); |
1da177e4 LT |
286 | |
287 | return 0; | |
288 | } | |
289 | ||
1da177e4 LT |
290 | static int fops_mmap(struct file *file, struct vm_area_struct * vma) |
291 | { | |
6694a560 | 292 | struct video_device *vdev = video_devdata(file); |
1da177e4 LT |
293 | struct saa7146_fh *fh = file->private_data; |
294 | struct videobuf_queue *q; | |
6de7d14d | 295 | int res; |
1da177e4 | 296 | |
6694a560 HV |
297 | switch (vdev->vfl_type) { |
298 | case VFL_TYPE_GRABBER: { | |
44d0b80e JP |
299 | DEB_EE("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, vma:%p\n", |
300 | file, vma); | |
1da177e4 LT |
301 | q = &fh->video_q; |
302 | break; | |
303 | } | |
6694a560 | 304 | case VFL_TYPE_VBI: { |
44d0b80e JP |
305 | DEB_EE("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, vma:%p\n", |
306 | file, vma); | |
a299e407 HV |
307 | if (fh->dev->ext_vv_data->capabilities & V4L2_CAP_SLICED_VBI_OUTPUT) |
308 | return -ENODEV; | |
1da177e4 LT |
309 | q = &fh->vbi_q; |
310 | break; | |
311 | } | |
312 | default: | |
313 | BUG(); | |
1da177e4 | 314 | } |
50c25fff | 315 | |
6de7d14d HV |
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; | |
1da177e4 LT |
321 | } |
322 | ||
c23e0cb8 | 323 | static __poll_t __fops_poll(struct file *file, struct poll_table_struct *wait) |
1da177e4 | 324 | { |
6694a560 | 325 | struct video_device *vdev = video_devdata(file); |
1da177e4 LT |
326 | struct saa7146_fh *fh = file->private_data; |
327 | struct videobuf_buffer *buf = NULL; | |
328 | struct videobuf_queue *q; | |
c23e0cb8 | 329 | __poll_t res = v4l2_ctrl_poll(file, wait); |
1da177e4 | 330 | |
44d0b80e | 331 | DEB_EE("file:%p, poll:%p\n", file, wait); |
1da177e4 | 332 | |
6694a560 | 333 | if (vdev->vfl_type == VFL_TYPE_VBI) { |
a299e407 | 334 | if (fh->dev->ext_vv_data->capabilities & V4L2_CAP_SLICED_VBI_OUTPUT) |
a9a08845 | 335 | return res | EPOLLOUT | EPOLLWRNORM; |
1da177e4 | 336 | if( 0 == fh->vbi_q.streaming ) |
537fa492 | 337 | return res | videobuf_poll_stream(file, &fh->vbi_q, wait); |
1da177e4 LT |
338 | q = &fh->vbi_q; |
339 | } else { | |
44d0b80e | 340 | DEB_D("using video queue\n"); |
1da177e4 LT |
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) { | |
44d0b80e | 348 | DEB_D("buf == NULL!\n"); |
a9a08845 | 349 | return res | EPOLLERR; |
1da177e4 LT |
350 | } |
351 | ||
352 | poll_wait(file, &buf->done, wait); | |
0fc0686e | 353 | if (buf->state == VIDEOBUF_DONE || buf->state == VIDEOBUF_ERROR) { |
44d0b80e | 354 | DEB_D("poll succeeded!\n"); |
a9a08845 | 355 | return res | EPOLLIN | EPOLLRDNORM; |
1da177e4 LT |
356 | } |
357 | ||
44d0b80e | 358 | DEB_D("nothing to poll for, buf->state:%d\n", buf->state); |
537fa492 | 359 | return res; |
1da177e4 LT |
360 | } |
361 | ||
c23e0cb8 | 362 | static __poll_t fops_poll(struct file *file, struct poll_table_struct *wait) |
6de7d14d HV |
363 | { |
364 | struct video_device *vdev = video_devdata(file); | |
c23e0cb8 | 365 | __poll_t res; |
6de7d14d HV |
366 | |
367 | mutex_lock(vdev->lock); | |
368 | res = __fops_poll(file, wait); | |
369 | mutex_unlock(vdev->lock); | |
370 | return res; | |
371 | } | |
372 | ||
1da177e4 LT |
373 | static ssize_t fops_read(struct file *file, char __user *data, size_t count, loff_t *ppos) |
374 | { | |
6694a560 | 375 | struct video_device *vdev = video_devdata(file); |
1da177e4 | 376 | struct saa7146_fh *fh = file->private_data; |
6de7d14d | 377 | int ret; |
1da177e4 | 378 | |
6694a560 HV |
379 | switch (vdev->vfl_type) { |
380 | case VFL_TYPE_GRABBER: | |
44d0b80e JP |
381 | /* |
382 | DEB_EE("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, data:%p, count:%lun", | |
383 | file, data, (unsigned long)count); | |
384 | */ | |
1da177e4 | 385 | return saa7146_video_uops.read(file,data,count,ppos); |
6694a560 | 386 | case VFL_TYPE_VBI: |
44d0b80e JP |
387 | /* |
388 | DEB_EE("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, data:%p, count:%lu\n", | |
389 | file, data, (unsigned long)count); | |
390 | */ | |
6de7d14d HV |
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 | } | |
44d0b80e | 398 | return -EINVAL; |
1da177e4 LT |
399 | default: |
400 | BUG(); | |
1da177e4 LT |
401 | } |
402 | } | |
403 | ||
5b0fa4ff OE |
404 | static ssize_t fops_write(struct file *file, const char __user *data, size_t count, loff_t *ppos) |
405 | { | |
6694a560 | 406 | struct video_device *vdev = video_devdata(file); |
5b0fa4ff | 407 | struct saa7146_fh *fh = file->private_data; |
6de7d14d | 408 | int ret; |
5b0fa4ff | 409 | |
6694a560 HV |
410 | switch (vdev->vfl_type) { |
411 | case VFL_TYPE_GRABBER: | |
5b0fa4ff | 412 | return -EINVAL; |
6694a560 | 413 | case VFL_TYPE_VBI: |
6de7d14d HV |
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; | |
5b0fa4ff OE |
422 | default: |
423 | BUG(); | |
5b0fa4ff OE |
424 | } |
425 | } | |
426 | ||
bec43661 | 427 | static const struct v4l2_file_operations video_fops = |
1da177e4 LT |
428 | { |
429 | .owner = THIS_MODULE, | |
430 | .open = fops_open, | |
431 | .release = fops_release, | |
432 | .read = fops_read, | |
5b0fa4ff | 433 | .write = fops_write, |
1da177e4 LT |
434 | .poll = fops_poll, |
435 | .mmap = fops_mmap, | |
9af39713 | 436 | .unlocked_ioctl = video_ioctl2, |
1da177e4 LT |
437 | }; |
438 | ||
52c1da39 | 439 | static void vv_callback(struct saa7146_dev *dev, unsigned long status) |
1da177e4 LT |
440 | { |
441 | u32 isr = status; | |
afd1a0c9 | 442 | |
44d0b80e | 443 | DEB_INT("dev:%p, isr:0x%08x\n", dev, (u32)status); |
1da177e4 LT |
444 | |
445 | if (0 != (isr & (MASK_27))) { | |
44d0b80e | 446 | DEB_INT("irq: RPS0 (0x%08x)\n", isr); |
1da177e4 LT |
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)) { | |
44d0b80e | 453 | DEB_INT("irq: RPS1 vbi workaround (0x%08x)\n", isr); |
1da177e4 LT |
454 | wake_up(&dev->vv_data->vbi_wq); |
455 | saa7146_write(dev,MC2, MASK_31); | |
456 | return; | |
457 | } | |
44d0b80e | 458 | DEB_INT("irq: RPS1 (0x%08x)\n", isr); |
1da177e4 LT |
459 | saa7146_vbi_uops.irq_done(dev,isr); |
460 | } | |
461 | } | |
462 | ||
6e65ca94 HV |
463 | static const struct v4l2_ctrl_ops saa7146_ctrl_ops = { |
464 | .s_ctrl = saa7146_s_ctrl, | |
465 | }; | |
466 | ||
1da177e4 LT |
467 | int saa7146_vv_init(struct saa7146_dev* dev, struct saa7146_ext_vv *ext_vv) |
468 | { | |
6e65ca94 | 469 | struct v4l2_ctrl_handler *hdl = &dev->ctrl_handler; |
5da545ad | 470 | struct v4l2_pix_format *fmt; |
fca3469a | 471 | struct v4l2_vbi_format *vbi; |
230b65f9 | 472 | struct saa7146_vv *vv; |
03b1930e HV |
473 | int err; |
474 | ||
475 | err = v4l2_device_register(&dev->pci->dev, &dev->v4l2_dev); | |
476 | if (err) | |
477 | return err; | |
230b65f9 | 478 | |
6e65ca94 HV |
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 | ||
230b65f9 | 497 | vv = kzalloc(sizeof(struct saa7146_vv), GFP_KERNEL); |
b960074f | 498 | if (vv == NULL) { |
44d0b80e | 499 | ERR("out of memory. aborting.\n"); |
6e65ca94 | 500 | v4l2_ctrl_handler_free(hdl); |
230b65f9 | 501 | return -ENOMEM; |
1da177e4 | 502 | } |
ab49ae0f HV |
503 | ext_vv->vid_ops = saa7146_video_ioctl_ops; |
504 | ext_vv->vbi_ops = saa7146_vbi_ioctl_ops; | |
b960074f | 505 | ext_vv->core_ops = &saa7146_video_ioctl_ops; |
1da177e4 | 506 | |
44d0b80e | 507 | DEB_EE("dev:%p\n", dev); |
1da177e4 LT |
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; | |
afd1a0c9 | 519 | |
6850aeab JP |
520 | vv->d_clipping.cpu_addr = |
521 | pci_zalloc_consistent(dev->pci, SAA7146_CLIPPING_MEM, | |
522 | &vv->d_clipping.dma_handle); | |
1da177e4 | 523 | if( NULL == vv->d_clipping.cpu_addr ) { |
44d0b80e | 524 | ERR("out of memory. aborting.\n"); |
1da177e4 | 525 | kfree(vv); |
6e65ca94 | 526 | v4l2_ctrl_handler_free(hdl); |
1da177e4 LT |
527 | return -1; |
528 | } | |
1da177e4 LT |
529 | |
530 | saa7146_video_uops.init(dev,vv); | |
5b0fa4ff OE |
531 | if (dev->ext_vv_data->capabilities & V4L2_CAP_VBI_CAPTURE) |
532 | saa7146_vbi_uops.init(dev,vv); | |
afd1a0c9 | 533 | |
c9adcb73 HV |
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; | |
fd74d6eb HV |
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 | ||
fca3469a HV |
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 | ||
3e314917 | 562 | timer_setup(&vv->vbi_read_timeout, NULL, 0); |
fca3469a | 563 | |
5da545ad HV |
564 | vv->ov_fb.capability = V4L2_FBUF_CAP_LIST_CLIPPING; |
565 | vv->ov_fb.flags = V4L2_FBUF_FLAG_PRIMARY; | |
1da177e4 LT |
566 | dev->vv_data = vv; |
567 | dev->vv_callback = &vv_callback; | |
568 | ||
569 | return 0; | |
570 | } | |
5d7dc8c4 | 571 | EXPORT_SYMBOL_GPL(saa7146_vv_init); |
1da177e4 LT |
572 | |
573 | int saa7146_vv_release(struct saa7146_dev* dev) | |
574 | { | |
575 | struct saa7146_vv *vv = dev->vv_data; | |
576 | ||
44d0b80e | 577 | DEB_EE("dev:%p\n", dev); |
afd1a0c9 | 578 | |
230b65f9 | 579 | v4l2_device_unregister(&dev->v4l2_dev); |
58af0045 | 580 | pci_free_consistent(dev->pci, SAA7146_CLIPPING_MEM, vv->d_clipping.cpu_addr, vv->d_clipping.dma_handle); |
6e65ca94 | 581 | v4l2_ctrl_handler_free(&dev->ctrl_handler); |
afd1a0c9 | 582 | kfree(vv); |
1da177e4 LT |
583 | dev->vv_data = NULL; |
584 | dev->vv_callback = NULL; | |
afd1a0c9 | 585 | |
1da177e4 LT |
586 | return 0; |
587 | } | |
5d7dc8c4 | 588 | EXPORT_SYMBOL_GPL(saa7146_vv_release); |
1da177e4 | 589 | |
3ae863e0 | 590 | int saa7146_register_device(struct video_device *vfd, struct saa7146_dev *dev, |
1da177e4 LT |
591 | char *name, int type) |
592 | { | |
b960074f | 593 | int err; |
d0852ed2 | 594 | int i; |
1da177e4 | 595 | |
44d0b80e | 596 | DEB_EE("dev:%p, name:'%s', type:%d\n", dev, name, type); |
1da177e4 | 597 | |
b960074f | 598 | vfd->fops = &video_fops; |
ab49ae0f HV |
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; | |
3ae863e0 | 603 | vfd->release = video_device_release_empty; |
9af39713 | 604 | vfd->lock = &dev->v4l2_lock; |
6e65ca94 | 605 | vfd->v4l2_dev = &dev->v4l2_dev; |
d0852ed2 HV |
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; | |
c0decac1 | 609 | strscpy(vfd->name, name, sizeof(vfd->name)); |
601e9444 | 610 | video_set_drvdata(vfd, dev); |
1da177e4 | 611 | |
b960074f HV |
612 | err = video_register_device(vfd, type, -1); |
613 | if (err < 0) { | |
44d0b80e | 614 | ERR("cannot register v4l2 device. skipping.\n"); |
b960074f | 615 | return err; |
1da177e4 LT |
616 | } |
617 | ||
44d0b80e JP |
618 | pr_info("%s: registered device %s [v4l2]\n", |
619 | dev->name, video_device_node_name(vfd)); | |
1da177e4 LT |
620 | return 0; |
621 | } | |
5d7dc8c4 | 622 | EXPORT_SYMBOL_GPL(saa7146_register_device); |
1da177e4 | 623 | |
3ae863e0 | 624 | int saa7146_unregister_device(struct video_device *vfd, struct saa7146_dev *dev) |
1da177e4 | 625 | { |
44d0b80e | 626 | DEB_EE("dev:%p\n", dev); |
1da177e4 | 627 | |
3ae863e0 | 628 | video_unregister_device(vfd); |
1da177e4 LT |
629 | return 0; |
630 | } | |
5d7dc8c4 | 631 | EXPORT_SYMBOL_GPL(saa7146_unregister_device); |
1da177e4 LT |
632 | |
633 | static int __init saa7146_vv_init_module(void) | |
634 | { | |
635 | return 0; | |
636 | } | |
637 | ||
638 | ||
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"); |