[media] media: ti-vpe: Use mem-to-mem ioctl helpers

1: Simplify the vpe mem-to-mem driver by using the m2m ioctl
   and vb2 helpers.
2: Align and arranged the v4l2_ioctl_ops.
3: Fixes a typo.
4: Use of_match_ptr() instead of explicitly defining the macro
   to NULL in case CONFIG_OF is not defined.

Signed-off-by: Lad, Prabhakar <prabhakar.csengg@gmail.com>
Signed-off-by: Hans Verkuil <hans.verkuil@cisco.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@osg.samsung.com>

diff --git a/drivers/media/platform/ti-vpe/vpe.c b/drivers/media/platform/ti-vpe/vpe.c
index 968fb63caf9430c349bdbed7e9a4af3e43556b93..c44760b705da7f68773767f4e6f007735326906b 100644 (file)
--- a/drivers/media/platform/ti-vpe/vpe.c
+++ b/drivers/media/platform/ti-vpe/vpe.c
@@ -25,6 +25,7 @@
 #include <linux/io.h>
 #include <linux/ioctl.h>
 #include <linux/module.h>
+#include <linux/of.h>
 #include <linux/platform_device.h>
 #include <linux/pm_runtime.h>
 #include <linux/sched.h>
@@ -74,7 +75,7 @@
 #define VPE_DEF_BUFS_PER_JOB   1       /* default one buffer per batch job */
 
 /*
- * each VPE context can need up to 3 config desciptors, 7 input descriptors,
+ * each VPE context can need up to 3 config descriptors, 7 input descriptors,
  * 3 output descriptors, and 10 control descriptors
  */
 #define VPE_DESC_LIST_SIZE     (10 * VPDMA_DTD_DESC_SIZE +     \
@@ -373,7 +374,6 @@ struct vpe_dev {
 struct vpe_ctx {
        struct v4l2_fh          fh;
        struct vpe_dev          *dev;
-       struct v4l2_m2m_ctx     *m2m_ctx;
        struct v4l2_ctrl_handler hdl;
 
        unsigned int            field;                  /* current field */
@@ -887,10 +887,10 @@ static int job_ready(void *priv)
        if (ctx->deinterlacing && ctx->src_vbs[2] == NULL)
                needed += 2;    /* need additional two most recent fields */
 
-       if (v4l2_m2m_num_src_bufs_ready(ctx->m2m_ctx) < needed)
+       if (v4l2_m2m_num_src_bufs_ready(ctx->fh.m2m_ctx) < needed)
                return 0;
 
-       if (v4l2_m2m_num_dst_bufs_ready(ctx->m2m_ctx) < needed)
+       if (v4l2_m2m_num_dst_bufs_ready(ctx->fh.m2m_ctx) < needed)
                return 0;
 
        return 1;
@@ -1100,15 +1100,15 @@ static void device_run(void *priv)
        struct vpe_q_data *d_q_data = &ctx->q_data[Q_DATA_DST];
 
        if (ctx->deinterlacing && ctx->src_vbs[2] == NULL) {
-               ctx->src_vbs[2] = v4l2_m2m_src_buf_remove(ctx->m2m_ctx);
+               ctx->src_vbs[2] = v4l2_m2m_src_buf_remove(ctx->fh.m2m_ctx);
                WARN_ON(ctx->src_vbs[2] == NULL);
-               ctx->src_vbs[1] = v4l2_m2m_src_buf_remove(ctx->m2m_ctx);
+               ctx->src_vbs[1] = v4l2_m2m_src_buf_remove(ctx->fh.m2m_ctx);
                WARN_ON(ctx->src_vbs[1] == NULL);
        }
 
-       ctx->src_vbs[0] = v4l2_m2m_src_buf_remove(ctx->m2m_ctx);
+       ctx->src_vbs[0] = v4l2_m2m_src_buf_remove(ctx->fh.m2m_ctx);
        WARN_ON(ctx->src_vbs[0] == NULL);
-       ctx->dst_vb = v4l2_m2m_dst_buf_remove(ctx->m2m_ctx);
+       ctx->dst_vb = v4l2_m2m_dst_buf_remove(ctx->fh.m2m_ctx);
        WARN_ON(ctx->dst_vb == NULL);
 
        /* config descriptors */
@@ -1334,7 +1334,7 @@ static irqreturn_t vpe_irq(int irq_vpe, void *data)
 finished:
        vpe_dbg(ctx->dev, "finishing transaction\n");
        ctx->bufs_completed = 0;
-       v4l2_m2m_job_finish(dev->m2m_dev, ctx->m2m_ctx);
+       v4l2_m2m_job_finish(dev->m2m_dev, ctx->fh.m2m_ctx);
 handled:
        return IRQ_HANDLED;
 }
@@ -1395,7 +1395,7 @@ static int vpe_g_fmt(struct file *file, void *priv, struct v4l2_format *f)
        struct vpe_q_data *q_data;
        int i;
 
-       vq = v4l2_m2m_get_vq(ctx->m2m_ctx, f->type);
+       vq = v4l2_m2m_get_vq(ctx->fh.m2m_ctx, f->type);
        if (!vq)
                return -EINVAL;
 
@@ -1527,7 +1527,7 @@ static int __vpe_s_fmt(struct vpe_ctx *ctx, struct v4l2_format *f)
        struct vb2_queue *vq;
        int i;
 
-       vq = v4l2_m2m_get_vq(ctx->m2m_ctx, f->type);
+       vq = v4l2_m2m_get_vq(ctx->fh.m2m_ctx, f->type);
        if (!vq)
                return -EINVAL;
 
@@ -1739,52 +1739,6 @@ static int vpe_s_selection(struct file *file, void *fh,
        return set_srcdst_params(ctx);
 }
 
-static int vpe_reqbufs(struct file *file, void *priv,
-                      struct v4l2_requestbuffers *reqbufs)
-{
-       struct vpe_ctx *ctx = file2ctx(file);
-
-       return v4l2_m2m_reqbufs(file, ctx->m2m_ctx, reqbufs);
-}
-
-static int vpe_querybuf(struct file *file, void *priv, struct v4l2_buffer *buf)
-{
-       struct vpe_ctx *ctx = file2ctx(file);
-
-       return v4l2_m2m_querybuf(file, ctx->m2m_ctx, buf);
-}
-
-static int vpe_qbuf(struct file *file, void *priv, struct v4l2_buffer *buf)
-{
-       struct vpe_ctx *ctx = file2ctx(file);
-
-       return v4l2_m2m_qbuf(file, ctx->m2m_ctx, buf);
-}
-
-static int vpe_dqbuf(struct file *file, void *priv, struct v4l2_buffer *buf)
-{
-       struct vpe_ctx *ctx = file2ctx(file);
-
-       return v4l2_m2m_dqbuf(file, ctx->m2m_ctx, buf);
-}
-
-static int vpe_streamon(struct file *file, void *priv, enum v4l2_buf_type type)
-{
-       struct vpe_ctx *ctx = file2ctx(file);
-
-       return v4l2_m2m_streamon(file, ctx->m2m_ctx, type);
-}
-
-static int vpe_streamoff(struct file *file, void *priv, enum v4l2_buf_type type)
-{
-       struct vpe_ctx *ctx = file2ctx(file);
-
-       vpe_dump_regs(ctx->dev);
-       vpdma_dump_regs(ctx->dev->vpdma);
-
-       return v4l2_m2m_streamoff(file, ctx->m2m_ctx, type);
-}
-
 /*
  * defines number of buffers/frames a context can process with VPE before
  * switching to a different context. default value is 1 buffer per context
@@ -1814,14 +1768,14 @@ static const struct v4l2_ctrl_ops vpe_ctrl_ops = {
 };
 
 static const struct v4l2_ioctl_ops vpe_ioctl_ops = {
-       .vidioc_querycap        = vpe_querycap,
+       .vidioc_querycap                = vpe_querycap,
 
-       .vidioc_enum_fmt_vid_cap_mplane = vpe_enum_fmt,
+       .vidioc_enum_fmt_vid_cap_mplane = vpe_enum_fmt,
        .vidioc_g_fmt_vid_cap_mplane    = vpe_g_fmt,
        .vidioc_try_fmt_vid_cap_mplane  = vpe_try_fmt,
        .vidioc_s_fmt_vid_cap_mplane    = vpe_s_fmt,
 
-       .vidioc_enum_fmt_vid_out_mplane = vpe_enum_fmt,
+       .vidioc_enum_fmt_vid_out_mplane = vpe_enum_fmt,
        .vidioc_g_fmt_vid_out_mplane    = vpe_g_fmt,
        .vidioc_try_fmt_vid_out_mplane  = vpe_try_fmt,
        .vidioc_s_fmt_vid_out_mplane    = vpe_s_fmt,
@@ -1829,16 +1783,15 @@ static const struct v4l2_ioctl_ops vpe_ioctl_ops = {
        .vidioc_g_selection             = vpe_g_selection,
        .vidioc_s_selection             = vpe_s_selection,
 
-       .vidioc_reqbufs         = vpe_reqbufs,
-       .vidioc_querybuf        = vpe_querybuf,
+       .vidioc_reqbufs                 = v4l2_m2m_ioctl_reqbufs,
+       .vidioc_querybuf                = v4l2_m2m_ioctl_querybuf,
+       .vidioc_qbuf                    = v4l2_m2m_ioctl_qbuf,
+       .vidioc_dqbuf                   = v4l2_m2m_ioctl_dqbuf,
+       .vidioc_streamon                = v4l2_m2m_ioctl_streamon,
+       .vidioc_streamoff               = v4l2_m2m_ioctl_streamoff,
 
-       .vidioc_qbuf            = vpe_qbuf,
-       .vidioc_dqbuf           = vpe_dqbuf,
-
-       .vidioc_streamon        = vpe_streamon,
-       .vidioc_streamoff       = vpe_streamoff,
-       .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
-       .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
+       .vidioc_subscribe_event         = v4l2_ctrl_subscribe_event,
+       .vidioc_unsubscribe_event       = v4l2_event_unsubscribe,
 };
 
 /*
@@ -1910,7 +1863,23 @@ static int vpe_buf_prepare(struct vb2_buffer *vb)
 static void vpe_buf_queue(struct vb2_buffer *vb)
 {
        struct vpe_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue);
-       v4l2_m2m_buf_queue(ctx->m2m_ctx, vb);
+
+       v4l2_m2m_buf_queue(ctx->fh.m2m_ctx, vb);
+}
+
+static int vpe_start_streaming(struct vb2_queue *q, unsigned int count)
+{
+       /* currently we do nothing here */
+
+       return 0;
+}
+
+static void vpe_stop_streaming(struct vb2_queue *q)
+{
+       struct vpe_ctx *ctx = vb2_get_drv_priv(q);
+
+       vpe_dump_regs(ctx->dev);
+       vpdma_dump_regs(ctx->dev->vpdma);
 }
 
 static struct vb2_ops vpe_qops = {
@@ -1919,6 +1888,8 @@ static struct vb2_ops vpe_qops = {
        .buf_queue       = vpe_buf_queue,
        .wait_prepare    = vb2_ops_wait_prepare,
        .wait_finish     = vb2_ops_wait_finish,
+       .start_streaming = vpe_start_streaming,
+       .stop_streaming  = vpe_stop_streaming,
 };
 
 static int queue_init(void *priv, struct vb2_queue *src_vq,
@@ -1972,9 +1943,9 @@ static const struct v4l2_ctrl_config vpe_bufs_per_job = {
 static int vpe_open(struct file *file)
 {
        struct vpe_dev *dev = video_drvdata(file);
-       struct vpe_ctx *ctx = NULL;
        struct vpe_q_data *s_q_data;
        struct v4l2_ctrl_handler *hdl;
+       struct vpe_ctx *ctx;
        int ret;
 
        vpe_dbg(dev, "vpe_open\n");
@@ -2047,10 +2018,10 @@ static int vpe_open(struct file *file)
        if (ret)
                goto exit_fh;
 
-       ctx->m2m_ctx = v4l2_m2m_ctx_init(dev->m2m_dev, ctx, &queue_init);
+       ctx->fh.m2m_ctx = v4l2_m2m_ctx_init(dev->m2m_dev, ctx, &queue_init);
 
-       if (IS_ERR(ctx->m2m_ctx)) {
-               ret = PTR_ERR(ctx->m2m_ctx);
+       if (IS_ERR(ctx->fh.m2m_ctx)) {
+               ret = PTR_ERR(ctx->fh.m2m_ctx);
                goto exit_fh;
        }
 
@@ -2069,7 +2040,7 @@ static int vpe_open(struct file *file)
        ctx->load_mmrs = true;
 
        vpe_dbg(dev, "created instance %p, m2m_ctx: %p\n",
-               ctx, ctx->m2m_ctx);
+               ctx, ctx->fh.m2m_ctx);
 
        mutex_unlock(&dev->dev_mutex);
 
@@ -2107,7 +2078,7 @@ static int vpe_release(struct file *file)
        v4l2_fh_del(&ctx->fh);
        v4l2_fh_exit(&ctx->fh);
        v4l2_ctrl_handler_free(&ctx->hdl);
-       v4l2_m2m_ctx_release(ctx->m2m_ctx);
+       v4l2_m2m_ctx_release(ctx->fh.m2m_ctx);
 
        kfree(ctx);
 
@@ -2124,39 +2095,13 @@ static int vpe_release(struct file *file)
        return 0;
 }
 
-static unsigned int vpe_poll(struct file *file,
-                            struct poll_table_struct *wait)
-{
-       struct vpe_ctx *ctx = file2ctx(file);
-       struct vpe_dev *dev = ctx->dev;
-       int ret;
-
-       mutex_lock(&dev->dev_mutex);
-       ret = v4l2_m2m_poll(file, ctx->m2m_ctx, wait);
-       mutex_unlock(&dev->dev_mutex);
-       return ret;
-}
-
-static int vpe_mmap(struct file *file, struct vm_area_struct *vma)
-{
-       struct vpe_ctx *ctx = file2ctx(file);
-       struct vpe_dev *dev = ctx->dev;
-       int ret;
-
-       if (mutex_lock_interruptible(&dev->dev_mutex))
-               return -ERESTARTSYS;
-       ret = v4l2_m2m_mmap(file, ctx->m2m_ctx, vma);
-       mutex_unlock(&dev->dev_mutex);
-       return ret;
-}
-
 static const struct v4l2_file_operations vpe_fops = {
        .owner          = THIS_MODULE,
        .open           = vpe_open,
        .release        = vpe_release,
-       .poll           = vpe_poll,
+       .poll           = v4l2_m2m_fop_poll,
        .unlocked_ioctl = video_ioctl2,
-       .mmap           = vpe_mmap,
+       .mmap           = v4l2_m2m_fop_mmap,
 };
 
 static struct video_device vpe_videodev = {
@@ -2358,8 +2303,6 @@ static const struct of_device_id vpe_of_match[] = {
        },
        {},
 };
-#else
-#define vpe_of_match NULL
 #endif
 
 static struct platform_driver vpe_pdrv = {
@@ -2367,7 +2310,7 @@ static struct platform_driver vpe_pdrv = {
        .remove         = vpe_remove,
        .driver         = {
                .name   = VPE_MODULE_NAME,
-               .of_match_table = vpe_of_match,
+               .of_match_table = of_match_ptr(vpe_of_match),
        },
 };