[08/11] add vbi code for tlg2300
Commit Message
This is the vbi module for tlg2300.
Signed-off-by: Huang Shijie <shijie8@gmail.com>
---
drivers/media/video/tlg2300/pd-vbi.c | 183 ++++++++++++++++++++++++++++++++++
1 files changed, 183 insertions(+), 0 deletions(-)
create mode 100644 drivers/media/video/tlg2300/pd-vbi.c
Comments
Huang Shijie wrote:
> This is the vbi module for tlg2300.
>
> Signed-off-by: Huang Shijie <shijie8@gmail.com>
> ---
> drivers/media/video/tlg2300/pd-vbi.c | 183 ++++++++++++++++++++++++++++++++++
> 1 files changed, 183 insertions(+), 0 deletions(-)
> create mode 100644 drivers/media/video/tlg2300/pd-vbi.c
>
> diff --git a/drivers/media/video/tlg2300/pd-vbi.c b/drivers/media/video/tlg2300/pd-vbi.c
> new file mode 100644
> index 0000000..fb9ee0d
> --- /dev/null
> +++ b/drivers/media/video/tlg2300/pd-vbi.c
> @@ -0,0 +1,183 @@
> +#include <linux/kernel.h>
> +#include <linux/usb.h>
> +#include <linux/kref.h>
> +#include <linux/uaccess.h>
> +#include <linux/mm.h>
> +#include <linux/vmalloc.h>
> +#include <linux/version.h>
> +#include <media/v4l2-common.h>
> +#include <linux/types.h>
> +#include <media/v4l2-dev.h>
> +#include <linux/fs.h>
> +#include <linux/poll.h>
> +#include <linux/slab.h>
> +#include <linux/string.h>
> +#include <linux/unistd.h>
> +
> +#include "vendorcmds.h"
> +#include "pd-common.h"
> +
> +int vbi_request_buf(struct vbi_data *vbi_data, size_t size)
> +{
> + int i, count = 4;
> +
> + pd_bufqueue_init(&vbi_data->vbi_queue, &count, size, KERNEL_MEM);
> +
> + for (i = 0; i < count; i++)
> + pd_bufqueue_qbuf(&vbi_data->vbi_queue, i);
> +
> + vbi_data->buf_count = count;
> + return 0;
> +}
> +
> +int vbi_release_buf(struct vbi_data *vbi_data)
> +{
> + if (vbi_data->buf_count) {
> + pd_bufqueue_cleanup(&vbi_data->vbi_queue);
> + pd_bufqueue_wakeup(&vbi_data->vbi_queue);
> + vbi_data->buf_count = 0;
> + }
> + return 0;
> +}
> +
> +static long vbi_v4l2_ioctl(struct file *file,
> + u32 cmd, unsigned long argp)
> +{
No. You should use struct v4l2_ioctl_ops for the ioctls. It should be noticed
that VBI setup should happen on _any_ V4L interface. So, the same ioctl that
sets video, should also set VBI.
So, the code bellow should be merged with the video part of the driver.
> + struct poseidon *pd = file->private_data;
> + int ret = 0;
> +
> + mutex_lock(&pd->lock);
> + switch (cmd) {
> + case VIDIOC_QUERYCAP: {
> + struct v4l2_capability *t_cap = (struct v4l2_capability *)argp;
> +
> + strcpy(t_cap->driver, "Telegent Driver");
> + strcpy(t_cap->card, "Telegent Poseidon");
> + strcpy(t_cap->bus_info, "USB bus");
> + t_cap->version = 0;
> + t_cap->capabilities = V4L2_CAP_VBI_CAPTURE;
> + }
> + break;
> +
> + case VIDIOC_S_FMT:
> + case VIDIOC_G_FMT: {
> + struct v4l2_format *v4l2_f = (struct v4l2_format *)argp;
> +
> + v4l2_f->fmt.vbi.sampling_rate = 6750000 * 4;
> + v4l2_f->fmt.vbi.samples_per_line = 720*2/* VBI_LINE_LENGTH */;
> + v4l2_f->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY;
> + v4l2_f->fmt.vbi.offset = 64 * 4; /*FIXME: why offset */
> + if (pd->video_data.tvnormid & V4L2_STD_525_60) {
> + v4l2_f->fmt.vbi.start[0] = 10;
> + v4l2_f->fmt.vbi.start[1] = 264;
> + v4l2_f->fmt.vbi.count[0] = V4L_NTSC_VBI_LINES;
> + v4l2_f->fmt.vbi.count[1] = V4L_NTSC_VBI_LINES;
> + } else {
> + v4l2_f->fmt.vbi.start[0] = 6;
> + v4l2_f->fmt.vbi.start[1] = 314;
> + v4l2_f->fmt.vbi.count[0] = V4L_PAL_VBI_LINES;
> + v4l2_f->fmt.vbi.count[1] = V4L_PAL_VBI_LINES;
> + }
> + /* VBI_UNSYNC VBI_INTERLACED */
> + v4l2_f->fmt.vbi.flags = V4L2_VBI_UNSYNC;
> + }
> + break;
> +
> + default:
> + ret = -EINVAL;
> + }
> + mutex_unlock(&pd->lock);
> + return ret;
> +}
> +
> +static ssize_t vbi_read(struct file *file, char __user *buffer,
> + size_t count, loff_t *ppos)
> +{
> + struct poseidon *pd = file->private_data;
> + struct vbi_data *vbi = &pd->vbi_data;
> +
> + return vbi->buf_count ?
> + pd_bufqueue_read(&vbi->vbi_queue, file->f_flags, buffer, count)
> + : -EINVAL;
> +}
> +
> +static int vbi_open(struct file *file)
> +{
> + int ret = 0;
> + struct video_device *vd = video_devdata(file);
> + struct poseidon *pd = video_get_drvdata(vd);
> +
> + if (!pd)
> + return -ENODEV;
> +
> + mutex_lock(&pd->lock);
> + if (pd->state & POSEIDON_STATE_DISCONNECT) {
> + ret = -ENODEV;
> + goto out;
> + }
> + kref_get(&pd->kref);
> + file->private_data = pd;
> + set_debug_mode(vd, debug_mode);
> +out:
> + mutex_unlock(&pd->lock);
> + return ret;
> +}
> +
> +static int vbi_release(struct file *file)
> +{
> + struct poseidon *pd = file->private_data;
> +
> + if (!pd)
> + return -ENODEV;
> +
> + kref_put(&pd->kref, poseidon_delete);
> + return 0;
> +}
> +
> +static const struct v4l2_file_operations vbi_file_ops = {
> + .owner = THIS_MODULE,
> + .open = vbi_open,
> + .release = vbi_release,
> + .read = vbi_read,
> + .ioctl = vbi_v4l2_ioctl,
> +};
> +
> +static struct video_device vbi_device = {
> + .name = "poseidon_vbi",
> + .fops = &vbi_file_ops,
> + .release = video_device_release,
> +};
> +
> +int vbi_init(struct poseidon *pd)
> +{
> + int ret = 0;
> +
> + memset(&(pd->vbi_data), 0, sizeof(struct vbi_data));
> +
> + pd->vbi_data.vbi_dev = vdev_init(pd, &vbi_device);
> + if (pd->vbi_data.vbi_dev == NULL) {
> + ret = -ENOMEM;
> + goto vbi_error;
> + }
> +
> + if (video_register_device(pd->vbi_data.vbi_dev, VFL_TYPE_VBI, -1) < 0) {
> + video_device_release(pd->vbi_data.vbi_dev);
> + pd->vbi_data.vbi_dev = NULL;
> + printk(KERN_DEBUG"vbi_init : video device register failed\n");
> + ret = -1;
> + }
> +
> +vbi_error:
> + return ret;
> +}
> +
> +int vbi_exit(struct poseidon *pd)
> +{
> + struct vbi_data *vbi_data = &pd->vbi_data;
> +
> + if (vbi_data->vbi_dev) {
> + video_unregister_device(vbi_data->vbi_dev);
> + vbi_data->vbi_dev = NULL;
> + }
> + return 0;
> +}
--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to majordomo@vger.kernel.org
More majordomo info at http://vger.kernel.org/majordomo-info.html
new file mode 100644
@@ -0,0 +1,183 @@
+#include <linux/kernel.h>
+#include <linux/usb.h>
+#include <linux/kref.h>
+#include <linux/uaccess.h>
+#include <linux/mm.h>
+#include <linux/vmalloc.h>
+#include <linux/version.h>
+#include <media/v4l2-common.h>
+#include <linux/types.h>
+#include <media/v4l2-dev.h>
+#include <linux/fs.h>
+#include <linux/poll.h>
+#include <linux/slab.h>
+#include <linux/string.h>
+#include <linux/unistd.h>
+
+#include "vendorcmds.h"
+#include "pd-common.h"
+
+int vbi_request_buf(struct vbi_data *vbi_data, size_t size)
+{
+ int i, count = 4;
+
+ pd_bufqueue_init(&vbi_data->vbi_queue, &count, size, KERNEL_MEM);
+
+ for (i = 0; i < count; i++)
+ pd_bufqueue_qbuf(&vbi_data->vbi_queue, i);
+
+ vbi_data->buf_count = count;
+ return 0;
+}
+
+int vbi_release_buf(struct vbi_data *vbi_data)
+{
+ if (vbi_data->buf_count) {
+ pd_bufqueue_cleanup(&vbi_data->vbi_queue);
+ pd_bufqueue_wakeup(&vbi_data->vbi_queue);
+ vbi_data->buf_count = 0;
+ }
+ return 0;
+}
+
+static long vbi_v4l2_ioctl(struct file *file,
+ u32 cmd, unsigned long argp)
+{
+ struct poseidon *pd = file->private_data;
+ int ret = 0;
+
+ mutex_lock(&pd->lock);
+ switch (cmd) {
+ case VIDIOC_QUERYCAP: {
+ struct v4l2_capability *t_cap = (struct v4l2_capability *)argp;
+
+ strcpy(t_cap->driver, "Telegent Driver");
+ strcpy(t_cap->card, "Telegent Poseidon");
+ strcpy(t_cap->bus_info, "USB bus");
+ t_cap->version = 0;
+ t_cap->capabilities = V4L2_CAP_VBI_CAPTURE;
+ }
+ break;
+
+ case VIDIOC_S_FMT:
+ case VIDIOC_G_FMT: {
+ struct v4l2_format *v4l2_f = (struct v4l2_format *)argp;
+
+ v4l2_f->fmt.vbi.sampling_rate = 6750000 * 4;
+ v4l2_f->fmt.vbi.samples_per_line = 720*2/* VBI_LINE_LENGTH */;
+ v4l2_f->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY;
+ v4l2_f->fmt.vbi.offset = 64 * 4; /*FIXME: why offset */
+ if (pd->video_data.tvnormid & V4L2_STD_525_60) {
+ v4l2_f->fmt.vbi.start[0] = 10;
+ v4l2_f->fmt.vbi.start[1] = 264;
+ v4l2_f->fmt.vbi.count[0] = V4L_NTSC_VBI_LINES;
+ v4l2_f->fmt.vbi.count[1] = V4L_NTSC_VBI_LINES;
+ } else {
+ v4l2_f->fmt.vbi.start[0] = 6;
+ v4l2_f->fmt.vbi.start[1] = 314;
+ v4l2_f->fmt.vbi.count[0] = V4L_PAL_VBI_LINES;
+ v4l2_f->fmt.vbi.count[1] = V4L_PAL_VBI_LINES;
+ }
+ /* VBI_UNSYNC VBI_INTERLACED */
+ v4l2_f->fmt.vbi.flags = V4L2_VBI_UNSYNC;
+ }
+ break;
+
+ default:
+ ret = -EINVAL;
+ }
+ mutex_unlock(&pd->lock);
+ return ret;
+}
+
+static ssize_t vbi_read(struct file *file, char __user *buffer,
+ size_t count, loff_t *ppos)
+{
+ struct poseidon *pd = file->private_data;
+ struct vbi_data *vbi = &pd->vbi_data;
+
+ return vbi->buf_count ?
+ pd_bufqueue_read(&vbi->vbi_queue, file->f_flags, buffer, count)
+ : -EINVAL;
+}
+
+static int vbi_open(struct file *file)
+{
+ int ret = 0;
+ struct video_device *vd = video_devdata(file);
+ struct poseidon *pd = video_get_drvdata(vd);
+
+ if (!pd)
+ return -ENODEV;
+
+ mutex_lock(&pd->lock);
+ if (pd->state & POSEIDON_STATE_DISCONNECT) {
+ ret = -ENODEV;
+ goto out;
+ }
+ kref_get(&pd->kref);
+ file->private_data = pd;
+ set_debug_mode(vd, debug_mode);
+out:
+ mutex_unlock(&pd->lock);
+ return ret;
+}
+
+static int vbi_release(struct file *file)
+{
+ struct poseidon *pd = file->private_data;
+
+ if (!pd)
+ return -ENODEV;
+
+ kref_put(&pd->kref, poseidon_delete);
+ return 0;
+}
+
+static const struct v4l2_file_operations vbi_file_ops = {
+ .owner = THIS_MODULE,
+ .open = vbi_open,
+ .release = vbi_release,
+ .read = vbi_read,
+ .ioctl = vbi_v4l2_ioctl,
+};
+
+static struct video_device vbi_device = {
+ .name = "poseidon_vbi",
+ .fops = &vbi_file_ops,
+ .release = video_device_release,
+};
+
+int vbi_init(struct poseidon *pd)
+{
+ int ret = 0;
+
+ memset(&(pd->vbi_data), 0, sizeof(struct vbi_data));
+
+ pd->vbi_data.vbi_dev = vdev_init(pd, &vbi_device);
+ if (pd->vbi_data.vbi_dev == NULL) {
+ ret = -ENOMEM;
+ goto vbi_error;
+ }
+
+ if (video_register_device(pd->vbi_data.vbi_dev, VFL_TYPE_VBI, -1) < 0) {
+ video_device_release(pd->vbi_data.vbi_dev);
+ pd->vbi_data.vbi_dev = NULL;
+ printk(KERN_DEBUG"vbi_init : video device register failed\n");
+ ret = -1;
+ }
+
+vbi_error:
+ return ret;
+}
+
+int vbi_exit(struct poseidon *pd)
+{
+ struct vbi_data *vbi_data = &pd->vbi_data;
+
+ if (vbi_data->vbi_dev) {
+ video_unregister_device(vbi_data->vbi_dev);
+ vbi_data->vbi_dev = NULL;
+ }
+ return 0;
+}