2 au0828-vbi.c - VBI driver for au0828
4 Copyright (C) 2010 Devin Heitmueller <dheitmueller@kernellabs.com>
6 This work was sponsored by GetWellNetwork Inc.
8 This program is free software; you can redistribute it and/or modify
9 it under the terms of the GNU General Public License as published by
10 the Free Software Foundation; either version 2 of the License, or
11 (at your option) any later version.
13 This program is distributed in the hope that it will be useful,
14 but WITHOUT ANY WARRANTY; without even the implied warranty of
15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 GNU General Public License for more details.
18 You should have received a copy of the GNU General Public License
19 along with this program; if not, write to the Free Software
20 Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
26 #include <linux/kernel.h>
27 #include <linux/module.h>
28 #include <linux/init.h>
29 #include <linux/slab.h>
31 /* ------------------------------------------------------------------ */
33 static int vbi_queue_setup(struct vb2_queue
*vq
, const void *parg
,
34 unsigned int *nbuffers
, unsigned int *nplanes
,
35 unsigned int sizes
[], void *alloc_ctxs
[])
37 const struct v4l2_format
*fmt
= parg
;
38 struct au0828_dev
*dev
= vb2_get_drv_priv(vq
);
39 unsigned long img_size
= dev
->vbi_width
* dev
->vbi_height
* 2;
42 size
= fmt
? (fmt
->fmt
.vbi
.samples_per_line
*
43 (fmt
->fmt
.vbi
.count
[0] + fmt
->fmt
.vbi
.count
[1])) : img_size
;
53 static int vbi_buffer_prepare(struct vb2_buffer
*vb
)
55 struct au0828_dev
*dev
= vb2_get_drv_priv(vb
->vb2_queue
);
58 size
= dev
->vbi_width
* dev
->vbi_height
* 2;
60 if (vb2_plane_size(vb
, 0) < size
) {
61 pr_err("%s data will not fit into plane (%lu < %lu)\n",
62 __func__
, vb2_plane_size(vb
, 0), size
);
65 vb2_set_plane_payload(vb
, 0, size
);
71 vbi_buffer_queue(struct vb2_buffer
*vb
)
73 struct au0828_dev
*dev
= vb2_get_drv_priv(vb
->vb2_queue
);
74 struct vb2_v4l2_buffer
*vbuf
= to_vb2_v4l2_buffer(vb
);
75 struct au0828_buffer
*buf
=
76 container_of(vbuf
, struct au0828_buffer
, vb
);
77 struct au0828_dmaqueue
*vbiq
= &dev
->vbiq
;
78 unsigned long flags
= 0;
80 buf
->mem
= vb2_plane_vaddr(vb
, 0);
81 buf
->length
= vb2_plane_size(vb
, 0);
83 spin_lock_irqsave(&dev
->slock
, flags
);
84 list_add_tail(&buf
->list
, &vbiq
->active
);
85 spin_unlock_irqrestore(&dev
->slock
, flags
);
88 struct vb2_ops au0828_vbi_qops
= {
89 .queue_setup
= vbi_queue_setup
,
90 .buf_prepare
= vbi_buffer_prepare
,
91 .buf_queue
= vbi_buffer_queue
,
92 .start_streaming
= au0828_start_analog_streaming
,
93 .stop_streaming
= au0828_stop_vbi_streaming
,
94 .wait_prepare
= vb2_ops_wait_prepare
,
95 .wait_finish
= vb2_ops_wait_finish
,