1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
3 | |
4 | #include <media/drv-intf/saa7146_vv.h> |
5 | #include <linux/module.h> |
6 | |
7 | /****************************************************************************/ |
8 | /* resource management functions, shamelessly stolen from saa7134 driver */ |
9 | |
10 | int saa7146_res_get(struct saa7146_dev *dev, unsigned int bit) |
11 | { |
12 | struct saa7146_vv *vv = dev->vv_data; |
13 | |
14 | if (vv->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 | vv->resources |= bit; |
30 | DEB_D("res: get 0x%02x, cur:0x%02x\n" , bit, vv->resources); |
31 | return 1; |
32 | } |
33 | |
34 | void saa7146_res_free(struct saa7146_dev *dev, unsigned int bits) |
35 | { |
36 | struct saa7146_vv *vv = dev->vv_data; |
37 | |
38 | WARN_ON((vv->resources & bits) != bits); |
39 | |
40 | vv->resources &= ~bits; |
41 | DEB_D("res: put 0x%02x, cur:0x%02x\n" , bits, vv->resources); |
42 | } |
43 | |
44 | |
45 | /********************************************************************************/ |
46 | /* common buffer functions */ |
47 | |
48 | int saa7146_buffer_queue(struct saa7146_dev *dev, |
49 | struct saa7146_dmaqueue *q, |
50 | struct saa7146_buf *buf) |
51 | { |
52 | assert_spin_locked(&dev->slock); |
53 | DEB_EE("dev:%p, dmaq:%p, buf:%p\n" , dev, q, buf); |
54 | |
55 | if (WARN_ON(!q)) |
56 | return -EIO; |
57 | |
58 | if (NULL == q->curr) { |
59 | q->curr = buf; |
60 | DEB_D("immediately activating buffer %p\n" , buf); |
61 | buf->activate(dev,buf,NULL); |
62 | } else { |
63 | list_add_tail(new: &buf->list, head: &q->queue); |
64 | DEB_D("adding buffer %p to queue. (active buffer present)\n" , |
65 | buf); |
66 | } |
67 | return 0; |
68 | } |
69 | |
70 | void saa7146_buffer_finish(struct saa7146_dev *dev, |
71 | struct saa7146_dmaqueue *q, |
72 | int state) |
73 | { |
74 | struct saa7146_vv *vv = dev->vv_data; |
75 | struct saa7146_buf *buf = q->curr; |
76 | |
77 | assert_spin_locked(&dev->slock); |
78 | DEB_EE("dev:%p, dmaq:%p, state:%d\n" , dev, q, state); |
79 | DEB_EE("q->curr:%p\n" , q->curr); |
80 | |
81 | /* finish current buffer */ |
82 | if (!buf) { |
83 | DEB_D("aiii. no current buffer\n" ); |
84 | return; |
85 | } |
86 | |
87 | q->curr = NULL; |
88 | buf->vb.vb2_buf.timestamp = ktime_get_ns(); |
89 | if (vv->video_fmt.field == V4L2_FIELD_ALTERNATE) |
90 | buf->vb.field = vv->last_field; |
91 | else if (vv->video_fmt.field == V4L2_FIELD_ANY) |
92 | buf->vb.field = (vv->video_fmt.height > vv->standard->v_max_out / 2) |
93 | ? V4L2_FIELD_INTERLACED |
94 | : V4L2_FIELD_BOTTOM; |
95 | else |
96 | buf->vb.field = vv->video_fmt.field; |
97 | buf->vb.sequence = vv->seqnr++; |
98 | vb2_buffer_done(vb: &buf->vb.vb2_buf, state); |
99 | } |
100 | |
101 | void saa7146_buffer_next(struct saa7146_dev *dev, |
102 | struct saa7146_dmaqueue *q, int vbi) |
103 | { |
104 | struct saa7146_buf *buf,*next = NULL; |
105 | |
106 | if (WARN_ON(!q)) |
107 | return; |
108 | |
109 | DEB_INT("dev:%p, dmaq:%p, vbi:%d\n" , dev, q, vbi); |
110 | |
111 | assert_spin_locked(&dev->slock); |
112 | if (!list_empty(head: &q->queue)) { |
113 | /* activate next one from queue */ |
114 | buf = list_entry(q->queue.next, struct saa7146_buf, list); |
115 | list_del(entry: &buf->list); |
116 | if (!list_empty(head: &q->queue)) |
117 | next = list_entry(q->queue.next, struct saa7146_buf, list); |
118 | q->curr = buf; |
119 | DEB_INT("next buffer: buf:%p, prev:%p, next:%p\n" , |
120 | buf, q->queue.prev, q->queue.next); |
121 | buf->activate(dev,buf,next); |
122 | } else { |
123 | DEB_INT("no next buffer. stopping.\n" ); |
124 | if( 0 != vbi ) { |
125 | /* turn off video-dma3 */ |
126 | saa7146_write(dev,MC1, MASK_20); |
127 | } else { |
128 | /* nothing to do -- just prevent next video-dma1 transfer |
129 | by lowering the protection address */ |
130 | |
131 | // fixme: fix this for vflip != 0 |
132 | |
133 | saa7146_write(dev, PROT_ADDR1, 0); |
134 | saa7146_write(dev, MC2, (MASK_02|MASK_18)); |
135 | |
136 | /* write the address of the rps-program */ |
137 | saa7146_write(dev, RPS_ADDR0, dev->d_rps0.dma_handle); |
138 | /* turn on rps */ |
139 | saa7146_write(dev, MC1, (MASK_12 | MASK_28)); |
140 | |
141 | /* |
142 | printk("vdma%d.base_even: 0x%08x\n", 1,saa7146_read(dev,BASE_EVEN1)); |
143 | printk("vdma%d.base_odd: 0x%08x\n", 1,saa7146_read(dev,BASE_ODD1)); |
144 | printk("vdma%d.prot_addr: 0x%08x\n", 1,saa7146_read(dev,PROT_ADDR1)); |
145 | printk("vdma%d.base_page: 0x%08x\n", 1,saa7146_read(dev,BASE_PAGE1)); |
146 | printk("vdma%d.pitch: 0x%08x\n", 1,saa7146_read(dev,PITCH1)); |
147 | printk("vdma%d.num_line_byte: 0x%08x\n", 1,saa7146_read(dev,NUM_LINE_BYTE1)); |
148 | */ |
149 | } |
150 | del_timer(timer: &q->timeout); |
151 | } |
152 | } |
153 | |
154 | void saa7146_buffer_timeout(struct timer_list *t) |
155 | { |
156 | struct saa7146_dmaqueue *q = from_timer(q, t, timeout); |
157 | struct saa7146_dev *dev = q->dev; |
158 | unsigned long flags; |
159 | |
160 | DEB_EE("dev:%p, dmaq:%p\n" , dev, q); |
161 | |
162 | spin_lock_irqsave(&dev->slock,flags); |
163 | if (q->curr) { |
164 | DEB_D("timeout on %p\n" , q->curr); |
165 | saa7146_buffer_finish(dev, q, state: VB2_BUF_STATE_ERROR); |
166 | } |
167 | |
168 | /* we don't restart the transfer here like other drivers do. when |
169 | a streaming capture is disabled, the timeout function will be |
170 | called for the current buffer. if we activate the next buffer now, |
171 | we mess up our capture logic. if a timeout occurs on another buffer, |
172 | then something is seriously broken before, so no need to buffer the |
173 | next capture IMHO... */ |
174 | |
175 | saa7146_buffer_next(dev, q, vbi: 0); |
176 | |
177 | spin_unlock_irqrestore(lock: &dev->slock,flags); |
178 | } |
179 | |
180 | /********************************************************************************/ |
181 | /* file operations */ |
182 | |
183 | static ssize_t fops_write(struct file *file, const char __user *data, size_t count, loff_t *ppos) |
184 | { |
185 | struct video_device *vdev = video_devdata(file); |
186 | struct saa7146_dev *dev = video_drvdata(file); |
187 | int ret; |
188 | |
189 | if (vdev->vfl_type != VFL_TYPE_VBI || !dev->ext_vv_data->vbi_fops.write) |
190 | return -EINVAL; |
191 | if (mutex_lock_interruptible(vdev->lock)) |
192 | return -ERESTARTSYS; |
193 | ret = dev->ext_vv_data->vbi_fops.write(file, data, count, ppos); |
194 | mutex_unlock(lock: vdev->lock); |
195 | return ret; |
196 | } |
197 | |
198 | static const struct v4l2_file_operations video_fops = |
199 | { |
200 | .owner = THIS_MODULE, |
201 | .open = v4l2_fh_open, |
202 | .release = vb2_fop_release, |
203 | .read = vb2_fop_read, |
204 | .write = fops_write, |
205 | .poll = vb2_fop_poll, |
206 | .mmap = vb2_fop_mmap, |
207 | .unlocked_ioctl = video_ioctl2, |
208 | }; |
209 | |
210 | static void vv_callback(struct saa7146_dev *dev, unsigned long status) |
211 | { |
212 | u32 isr = status; |
213 | |
214 | DEB_INT("dev:%p, isr:0x%08x\n" , dev, (u32)status); |
215 | |
216 | if (0 != (isr & (MASK_27))) { |
217 | DEB_INT("irq: RPS0 (0x%08x)\n" , isr); |
218 | saa7146_video_uops.irq_done(dev,isr); |
219 | } |
220 | |
221 | if (0 != (isr & (MASK_28))) { |
222 | u32 mc2 = saa7146_read(dev, MC2); |
223 | if( 0 != (mc2 & MASK_15)) { |
224 | DEB_INT("irq: RPS1 vbi workaround (0x%08x)\n" , isr); |
225 | wake_up(&dev->vv_data->vbi_wq); |
226 | saa7146_write(dev,MC2, MASK_31); |
227 | return; |
228 | } |
229 | DEB_INT("irq: RPS1 (0x%08x)\n" , isr); |
230 | saa7146_vbi_uops.irq_done(dev,isr); |
231 | } |
232 | } |
233 | |
234 | static const struct v4l2_ctrl_ops saa7146_ctrl_ops = { |
235 | .s_ctrl = saa7146_s_ctrl, |
236 | }; |
237 | |
238 | int saa7146_vv_init(struct saa7146_dev* dev, struct saa7146_ext_vv *ext_vv) |
239 | { |
240 | struct v4l2_ctrl_handler *hdl = &dev->ctrl_handler; |
241 | struct v4l2_pix_format *fmt; |
242 | struct v4l2_vbi_format *vbi; |
243 | struct saa7146_vv *vv; |
244 | int err; |
245 | |
246 | err = v4l2_device_register(dev: &dev->pci->dev, v4l2_dev: &dev->v4l2_dev); |
247 | if (err) |
248 | return err; |
249 | |
250 | v4l2_ctrl_handler_init(hdl, 6); |
251 | v4l2_ctrl_new_std(hdl, ops: &saa7146_ctrl_ops, |
252 | V4L2_CID_BRIGHTNESS, min: 0, max: 255, step: 1, def: 128); |
253 | v4l2_ctrl_new_std(hdl, ops: &saa7146_ctrl_ops, |
254 | V4L2_CID_CONTRAST, min: 0, max: 127, step: 1, def: 64); |
255 | v4l2_ctrl_new_std(hdl, ops: &saa7146_ctrl_ops, |
256 | V4L2_CID_SATURATION, min: 0, max: 127, step: 1, def: 64); |
257 | v4l2_ctrl_new_std(hdl, ops: &saa7146_ctrl_ops, |
258 | V4L2_CID_VFLIP, min: 0, max: 1, step: 1, def: 0); |
259 | v4l2_ctrl_new_std(hdl, ops: &saa7146_ctrl_ops, |
260 | V4L2_CID_HFLIP, min: 0, max: 1, step: 1, def: 0); |
261 | if (hdl->error) { |
262 | err = hdl->error; |
263 | v4l2_ctrl_handler_free(hdl); |
264 | v4l2_device_unregister(v4l2_dev: &dev->v4l2_dev); |
265 | return err; |
266 | } |
267 | dev->v4l2_dev.ctrl_handler = hdl; |
268 | |
269 | vv = kzalloc(size: sizeof(struct saa7146_vv), GFP_KERNEL); |
270 | if (vv == NULL) { |
271 | ERR("out of memory. aborting.\n" ); |
272 | v4l2_ctrl_handler_free(hdl); |
273 | v4l2_device_unregister(v4l2_dev: &dev->v4l2_dev); |
274 | return -ENOMEM; |
275 | } |
276 | ext_vv->vid_ops = saa7146_video_ioctl_ops; |
277 | ext_vv->vbi_ops = saa7146_vbi_ioctl_ops; |
278 | ext_vv->core_ops = &saa7146_video_ioctl_ops; |
279 | |
280 | DEB_EE("dev:%p\n" , dev); |
281 | |
282 | /* set default values for video parts of the saa7146 */ |
283 | saa7146_write(dev, BCS_CTRL, 0x80400040); |
284 | |
285 | /* enable video-port pins */ |
286 | saa7146_write(dev, MC1, (MASK_10 | MASK_26)); |
287 | |
288 | /* save per-device extension data (one extension can |
289 | handle different devices that might need different |
290 | configuration data) */ |
291 | dev->ext_vv_data = ext_vv; |
292 | |
293 | saa7146_video_uops.init(dev,vv); |
294 | if (dev->ext_vv_data->capabilities & V4L2_CAP_VBI_CAPTURE) |
295 | saa7146_vbi_uops.init(dev,vv); |
296 | |
297 | fmt = &vv->video_fmt; |
298 | fmt->width = 384; |
299 | fmt->height = 288; |
300 | fmt->pixelformat = V4L2_PIX_FMT_BGR24; |
301 | fmt->field = V4L2_FIELD_INTERLACED; |
302 | fmt->colorspace = V4L2_COLORSPACE_SMPTE170M; |
303 | fmt->bytesperline = 3 * fmt->width; |
304 | fmt->sizeimage = fmt->bytesperline * fmt->height; |
305 | |
306 | vbi = &vv->vbi_fmt; |
307 | vbi->sampling_rate = 27000000; |
308 | vbi->offset = 248; /* todo */ |
309 | vbi->samples_per_line = 720 * 2; |
310 | vbi->sample_format = V4L2_PIX_FMT_GREY; |
311 | |
312 | /* fixme: this only works for PAL */ |
313 | vbi->start[0] = 5; |
314 | vbi->count[0] = 16; |
315 | vbi->start[1] = 312; |
316 | vbi->count[1] = 16; |
317 | |
318 | timer_setup(&vv->vbi_read_timeout, NULL, 0); |
319 | |
320 | dev->vv_data = vv; |
321 | dev->vv_callback = &vv_callback; |
322 | |
323 | return 0; |
324 | } |
325 | EXPORT_SYMBOL_GPL(saa7146_vv_init); |
326 | |
327 | int saa7146_vv_release(struct saa7146_dev* dev) |
328 | { |
329 | struct saa7146_vv *vv = dev->vv_data; |
330 | |
331 | DEB_EE("dev:%p\n" , dev); |
332 | |
333 | v4l2_device_unregister(v4l2_dev: &dev->v4l2_dev); |
334 | v4l2_ctrl_handler_free(hdl: &dev->ctrl_handler); |
335 | kfree(objp: vv); |
336 | dev->vv_data = NULL; |
337 | dev->vv_callback = NULL; |
338 | |
339 | return 0; |
340 | } |
341 | EXPORT_SYMBOL_GPL(saa7146_vv_release); |
342 | |
343 | int saa7146_register_device(struct video_device *vfd, struct saa7146_dev *dev, |
344 | char *name, int type) |
345 | { |
346 | struct vb2_queue *q; |
347 | int err; |
348 | int i; |
349 | |
350 | DEB_EE("dev:%p, name:'%s', type:%d\n" , dev, name, type); |
351 | |
352 | vfd->fops = &video_fops; |
353 | if (type == VFL_TYPE_VIDEO) { |
354 | vfd->ioctl_ops = &dev->ext_vv_data->vid_ops; |
355 | q = &dev->vv_data->video_dmaq.q; |
356 | } else { |
357 | vfd->ioctl_ops = &dev->ext_vv_data->vbi_ops; |
358 | q = &dev->vv_data->vbi_dmaq.q; |
359 | } |
360 | vfd->release = video_device_release_empty; |
361 | vfd->lock = &dev->v4l2_lock; |
362 | vfd->v4l2_dev = &dev->v4l2_dev; |
363 | vfd->tvnorms = 0; |
364 | for (i = 0; i < dev->ext_vv_data->num_stds; i++) |
365 | vfd->tvnorms |= dev->ext_vv_data->stds[i].id; |
366 | strscpy(vfd->name, name, sizeof(vfd->name)); |
367 | vfd->device_caps = V4L2_CAP_VIDEO_CAPTURE | |
368 | V4L2_CAP_READWRITE | V4L2_CAP_STREAMING; |
369 | vfd->device_caps |= dev->ext_vv_data->capabilities; |
370 | if (type == VFL_TYPE_VIDEO) { |
371 | vfd->device_caps &= |
372 | ~(V4L2_CAP_VBI_CAPTURE | V4L2_CAP_SLICED_VBI_OUTPUT); |
373 | } else if (vfd->device_caps & V4L2_CAP_SLICED_VBI_OUTPUT) { |
374 | vfd->vfl_dir = VFL_DIR_TX; |
375 | vfd->device_caps &= ~(V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING | |
376 | V4L2_CAP_AUDIO | V4L2_CAP_TUNER); |
377 | } else { |
378 | vfd->device_caps &= ~V4L2_CAP_VIDEO_CAPTURE; |
379 | } |
380 | |
381 | q->type = type == VFL_TYPE_VIDEO ? V4L2_BUF_TYPE_VIDEO_CAPTURE : V4L2_BUF_TYPE_VBI_CAPTURE; |
382 | q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; |
383 | q->io_modes = VB2_MMAP | VB2_READ | VB2_DMABUF; |
384 | q->ops = type == VFL_TYPE_VIDEO ? &video_qops : &vbi_qops; |
385 | q->mem_ops = &vb2_dma_sg_memops; |
386 | q->drv_priv = dev; |
387 | q->gfp_flags = __GFP_DMA32; |
388 | q->buf_struct_size = sizeof(struct saa7146_buf); |
389 | q->lock = &dev->v4l2_lock; |
390 | q->min_queued_buffers = 2; |
391 | q->dev = &dev->pci->dev; |
392 | err = vb2_queue_init(q); |
393 | if (err) |
394 | return err; |
395 | vfd->queue = q; |
396 | |
397 | video_set_drvdata(vdev: vfd, data: dev); |
398 | |
399 | err = video_register_device(vdev: vfd, type, nr: -1); |
400 | if (err < 0) { |
401 | ERR("cannot register v4l2 device. skipping.\n" ); |
402 | return err; |
403 | } |
404 | |
405 | pr_info("%s: registered device %s [v4l2]\n" , |
406 | dev->name, video_device_node_name(vfd)); |
407 | return 0; |
408 | } |
409 | EXPORT_SYMBOL_GPL(saa7146_register_device); |
410 | |
411 | int saa7146_unregister_device(struct video_device *vfd, struct saa7146_dev *dev) |
412 | { |
413 | DEB_EE("dev:%p\n" , dev); |
414 | |
415 | video_unregister_device(vdev: vfd); |
416 | return 0; |
417 | } |
418 | EXPORT_SYMBOL_GPL(saa7146_unregister_device); |
419 | |
420 | static int __init saa7146_vv_init_module(void) |
421 | { |
422 | return 0; |
423 | } |
424 | |
425 | |
426 | static void __exit saa7146_vv_cleanup_module(void) |
427 | { |
428 | } |
429 | |
430 | module_init(saa7146_vv_init_module); |
431 | module_exit(saa7146_vv_cleanup_module); |
432 | |
433 | MODULE_AUTHOR("Michael Hunold <michael@mihu.de>" ); |
434 | MODULE_DESCRIPTION("video4linux driver for saa7146-based hardware" ); |
435 | MODULE_LICENSE("GPL" ); |
436 | |