[media] vimc: common: Add vimc_pipeline_s_stream helper

Move the vimc_cap_pipeline_s_stream from the vimc-cap.c to vimc-common.c
as this core will be reused by other subdevices to activate the stream
in their directly connected nodes

Signed-off-by: Helen Koike <helen.koike@collabora.com>
Signed-off-by: Hans Verkuil <hans.verkuil@cisco.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@s-opensource.com>

1 files changed, 32 insertions, 0 deletions

diff --git a/drivers/media/platform/vimc/vimc-common.c b/drivers/media/platform/vimc/vimc-common.c
index 3afbabd739a5..f809a9d756b9 100644
--- a/drivers/media/platform/vimc/vimc-common.c
+++ b/drivers/media/platform/vimc/vimc-common.c
@@ -220,6 +220,38 @@ struct media_pad *vimc_pads_init(u16 num_pads, const unsigned long *pads_flag)
         return pads;
 }
 
+int vimc_pipeline_s_stream(struct media_entity *ent, int enable)
+{
+        struct v4l2_subdev *sd;
+        struct media_pad *pad;
+        unsigned int i;
+        int ret;
+
+        for (i = 0; i < ent->num_pads; i++) {
+                if (ent->pads[i].flags & MEDIA_PAD_FL_SOURCE)
+                        continue;
+
+                /* Start the stream in the subdevice direct connected */
+                pad = media_entity_remote_pad(&ent->pads[i]);
+
+                /*
+                 * if this is a raw node from vimc-core, then there is
+                 * nothing to activate
+                 * TODO: remove this when there are no more raw nodes in the
+                 * core and return error instead
+                 */
+                if (pad->entity->obj_type == MEDIA_ENTITY_TYPE_BASE)
+                        continue;
+
+                sd = media_entity_to_v4l2_subdev(pad->entity);
+                ret = v4l2_subdev_call(sd, video, s_stream, enable);
+                if (ret && ret != -ENOIOCTLCMD)
+                        return ret;
+        }
+
+        return 0;
+}
+
 static const struct media_entity_operations vimc_ent_sd_mops = {
         .link_validate = v4l2_subdev_link_validate,
 };