From: Stanimir Varbanov <svarba...@mm-sol.com>

Used for storing subdev information per file handle and hold V4L2 file
handle.

Signed-off-by: Stanimir Varbanov <svarba...@mm-sol.com>
Signed-off-by: Antti Koskipaa <antti.koski...@nokia.com>
Signed-off-by: Laurent Pinchart <laurent.pinch...@ideasonboard.com>
---
 drivers/media/video/v4l2-subdev.c |   82 +++++++++++++++++++++++++------------
 include/media/v4l2-subdev.h       |   25 +++++++++++
 2 files changed, 80 insertions(+), 27 deletions(-)

diff --git a/drivers/media/video/v4l2-subdev.c 
b/drivers/media/video/v4l2-subdev.c
index 731dc12..d2891c1 100644
--- a/drivers/media/video/v4l2-subdev.c
+++ b/drivers/media/video/v4l2-subdev.c
@@ -30,38 +30,66 @@
 #include <media/v4l2-fh.h>
 #include <media/v4l2-event.h>
 
+static int subdev_fh_init(struct v4l2_subdev_fh *fh, struct v4l2_subdev *sd)
+{
+       /* Allocate probe format and crop in the same memory block */
+       fh->probe_fmt = kzalloc((sizeof(*fh->probe_fmt) +
+                               sizeof(*fh->probe_crop)) * sd->entity.num_pads,
+                               GFP_KERNEL);
+       if (fh->probe_fmt == NULL)
+               return -ENOMEM;
+
+       fh->probe_crop = (struct v4l2_rect *)
+               (fh->probe_fmt + sd->entity.num_pads);
+
+       return 0;
+}
+
+static void subdev_fh_free(struct v4l2_subdev_fh *fh)
+{
+       kfree(fh->probe_fmt);
+       fh->probe_fmt = NULL;
+       fh->probe_crop = NULL;
+}
+
 static int subdev_open(struct file *file)
 {
        struct video_device *vdev = video_devdata(file);
        struct v4l2_subdev *sd = vdev_to_v4l2_subdev(vdev);
+       struct v4l2_subdev_fh *subdev_fh;
        struct media_entity *entity;
-       struct v4l2_fh *vfh = NULL;
        int ret;
 
        if (!sd->initialized)
                return -EAGAIN;
 
-       if (sd->flags & V4L2_SUBDEV_FL_HAS_EVENTS) {
-               vfh = kzalloc(sizeof(*vfh), GFP_KERNEL);
-               if (vfh == NULL)
-                       return -ENOMEM;
+       subdev_fh = kzalloc(sizeof(*subdev_fh), GFP_KERNEL);
+       if (subdev_fh == NULL)
+               return -ENOMEM;
 
-               ret = v4l2_fh_init(vfh, vdev);
-               if (ret)
-                       goto err;
+       ret = subdev_fh_init(subdev_fh, sd);
+       if (ret) {
+               kfree(subdev_fh);
+               return ret;
+       }
+
+       ret = v4l2_fh_init(&subdev_fh->vfh, vdev);
+       if (ret)
+               goto err;
 
-               ret = v4l2_event_init(vfh);
+       if (sd->flags & V4L2_SUBDEV_FL_HAS_EVENTS) {
+               ret = v4l2_event_init(&subdev_fh->vfh);
                if (ret)
                        goto err;
 
-               ret = v4l2_event_alloc(vfh, sd->nevents);
+               ret = v4l2_event_alloc(&subdev_fh->vfh, sd->nevents);
                if (ret)
                        goto err;
-
-               v4l2_fh_add(vfh);
-               file->private_data = vfh;
        }
 
+       v4l2_fh_add(&subdev_fh->vfh);
+       file->private_data = &subdev_fh->vfh;
+
        if (sd->v4l2_dev->mdev) {
                entity = media_entity_get(&sd->entity);
                if (!entity) {
@@ -73,11 +101,10 @@ static int subdev_open(struct file *file)
        return 0;
 
 err:
-       if (vfh != NULL) {
-               v4l2_fh_del(vfh);
-               v4l2_fh_exit(vfh);
-               kfree(vfh);
-       }
+       v4l2_fh_del(&subdev_fh->vfh);
+       v4l2_fh_exit(&subdev_fh->vfh);
+       subdev_fh_free(subdev_fh);
+       kfree(subdev_fh);
 
        return ret;
 }
@@ -87,15 +114,16 @@ static int subdev_close(struct file *file)
        struct video_device *vdev = video_devdata(file);
        struct v4l2_subdev *sd = vdev_to_v4l2_subdev(vdev);
        struct v4l2_fh *vfh = file->private_data;
+       struct v4l2_subdev_fh *subdev_fh = to_v4l2_subdev_fh(vfh);
 
        if (sd->v4l2_dev->mdev)
                media_entity_put(&sd->entity);
 
-       if (vfh != NULL) {
-               v4l2_fh_del(vfh);
-               v4l2_fh_exit(vfh);
-               kfree(vfh);
-       }
+       v4l2_fh_del(vfh);
+       v4l2_fh_exit(vfh);
+       subdev_fh_free(subdev_fh);
+       kfree(subdev_fh);
+       file->private_data = NULL;
 
        return 0;
 }
@@ -104,7 +132,7 @@ static long subdev_do_ioctl(struct file *file, unsigned int 
cmd, void *arg)
 {
        struct video_device *vdev = video_devdata(file);
        struct v4l2_subdev *sd = vdev_to_v4l2_subdev(vdev);
-       struct v4l2_fh *fh = file->private_data;
+       struct v4l2_fh *vfh = file->private_data;
 
        switch (cmd) {
        case VIDIOC_QUERYCTRL:
@@ -132,13 +160,13 @@ static long subdev_do_ioctl(struct file *file, unsigned 
int cmd, void *arg)
                if (!(sd->flags & V4L2_SUBDEV_FL_HAS_EVENTS))
                        return -ENOIOCTLCMD;
 
-               return v4l2_event_dequeue(fh, arg, file->f_flags & O_NONBLOCK);
+               return v4l2_event_dequeue(vfh, arg, file->f_flags & O_NONBLOCK);
 
        case VIDIOC_SUBSCRIBE_EVENT:
-               return v4l2_subdev_call(sd, core, subscribe_event, fh, arg);
+               return v4l2_subdev_call(sd, core, subscribe_event, vfh, arg);
 
        case VIDIOC_UNSUBSCRIBE_EVENT:
-               return v4l2_subdev_call(sd, core, unsubscribe_event, fh, arg);
+               return v4l2_subdev_call(sd, core, unsubscribe_event, vfh, arg);
 
        default:
                return -ENOIOCTLCMD;
diff --git a/include/media/v4l2-subdev.h b/include/media/v4l2-subdev.h
index 57ef74f..212fc54 100644
--- a/include/media/v4l2-subdev.h
+++ b/include/media/v4l2-subdev.h
@@ -24,6 +24,7 @@
 #include <media/media-entity.h>
 #include <media/v4l2-common.h>
 #include <media/v4l2-dev.h>
+#include <media/v4l2-fh.h>
 #include <media/v4l2-mediabus.h>
 
 /* generic v4l2_device notify callback notification values */
@@ -469,6 +470,30 @@ struct v4l2_subdev {
 #define vdev_to_v4l2_subdev(vdev) \
        container_of(vdev, struct v4l2_subdev, devnode)
 
+/*
+ * Used for storing subdev information per file handle
+ */
+struct v4l2_subdev_fh {
+       struct v4l2_fh vfh;
+       struct v4l2_mbus_framefmt *probe_fmt;
+       struct v4l2_rect *probe_crop;
+};
+
+#define to_v4l2_subdev_fh(fh)  \
+       container_of(fh, struct v4l2_subdev_fh, vfh)
+
+static inline struct v4l2_mbus_framefmt *
+v4l2_subdev_get_probe_format(struct v4l2_subdev_fh *fh, unsigned int pad)
+{
+       return &fh->probe_fmt[pad];
+}
+
+static inline struct v4l2_rect *
+v4l2_subdev_get_probe_crop(struct v4l2_subdev_fh *fh, unsigned int pad)
+{
+       return &fh->probe_crop[pad];
+}
+
 extern const struct v4l2_file_operations v4l2_subdev_fops;
 
 static inline void v4l2_set_subdevdata(struct v4l2_subdev *sd, void *p)
-- 
1.7.2.2

--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to