media: rzg2l-cru: Retrieve virtual channel information

The RZ/G2L CRU needs to configure the ICnMC.VCSEL bits to specify which
virtual channel should be processed from the four available VCs. To
retrieve this information from the connected subdevice, the
.get_frame_desc() function is called.

Signed-off-by: Lad Prabhakar <prabhakar.mahadev-lad.rj@bp.renesas.com>
Reviewed-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Link: https://lore.kernel.org/r/20241018133446.223516-7-prabhakar.mahadev-lad.rj@bp.renesas.com
Signed-off-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Signed-off-by: Hans Verkuil <hverkuil@xs4all.nl>

diff --git a/drivers/media/platform/renesas/rzg2l-cru/rzg2l-cru.h b/drivers/media/platform/renesas/rzg2l-cru/rzg2l-cru.h
index 1747602395481f3eb77452705d28b83399c07f84..8fbd45c437634d1136bb77a956438d087f20de57 100644 (file)
--- a/drivers/media/platform/renesas/rzg2l-cru/rzg2l-cru.h
+++ b/drivers/media/platform/renesas/rzg2l-cru/rzg2l-cru.h
@@ -31,6 +31,11 @@
 #define RZG2L_CRU_MIN_INPUT_HEIGHT     240
 #define RZG2L_CRU_MAX_INPUT_HEIGHT     4095
 
+enum rzg2l_csi2_pads {
+       RZG2L_CRU_IP_SINK = 0,
+       RZG2L_CRU_IP_SOURCE,
+};
+
 /**
  * enum rzg2l_cru_dma_state - DMA states
  * @RZG2L_CRU_DMA_STOPPED:   No operation in progress

diff --git a/drivers/media/platform/renesas/rzg2l-cru/rzg2l-ip.c b/drivers/media/platform/renesas/rzg2l-cru/rzg2l-ip.c
index 700d8b7046898a4f6246cae46a28a746c67c728b..aee7d4ba70b0002777075bcdf3a5d3d2aba37ef2 100644 (file)
--- a/drivers/media/platform/renesas/rzg2l-cru/rzg2l-ip.c
+++ b/drivers/media/platform/renesas/rzg2l-cru/rzg2l-ip.c
@@ -18,11 +18,6 @@ static const struct rzg2l_cru_ip_format rzg2l_cru_ip_formats[] = {
        { .code = MEDIA_BUS_FMT_UYVY8_1X16,     .datatype = 0x1e, .bpp = 16 },
 };
 
-enum rzg2l_csi2_pads {
-       RZG2L_CRU_IP_SINK = 0,
-       RZG2L_CRU_IP_SOURCE,
-};
-
 static const struct rzg2l_cru_ip_format *rzg2l_cru_ip_code_to_fmt(unsigned int code)
 {
        unsigned int i;

diff --git a/drivers/media/platform/renesas/rzg2l-cru/rzg2l-video.c b/drivers/media/platform/renesas/rzg2l-cru/rzg2l-video.c
index bbf4674f888d0b0281d60d37bd2df1a134d379bf..7cd33eb1939cbab02088773ffbade5bb8a670731 100644 (file)
--- a/drivers/media/platform/renesas/rzg2l-cru/rzg2l-video.c
+++ b/drivers/media/platform/renesas/rzg2l-cru/rzg2l-video.c
@@ -433,12 +433,46 @@ void rzg2l_cru_stop_image_processing(struct rzg2l_cru_dev *cru)
        spin_unlock_irqrestore(&cru->qlock, flags);
 }
 
+static int rzg2l_cru_get_virtual_channel(struct rzg2l_cru_dev *cru)
+{
+       struct v4l2_mbus_frame_desc fd = { };
+       struct media_pad *remote_pad;
+       int ret;
+
+       remote_pad = media_pad_remote_pad_unique(&cru->ip.pads[RZG2L_CRU_IP_SINK]);
+       ret = v4l2_subdev_call(cru->ip.remote, pad, get_frame_desc, remote_pad->index, &fd);
+       if (ret < 0 && ret != -ENOIOCTLCMD) {
+               dev_err(cru->dev, "get_frame_desc failed on IP remote subdev\n");
+               return ret;
+       }
+       /* If remote subdev does not implement .get_frame_desc default to VC0. */
+       if (ret == -ENOIOCTLCMD)
+               return 0;
+
+       if (fd.type != V4L2_MBUS_FRAME_DESC_TYPE_CSI2) {
+               dev_err(cru->dev, "get_frame_desc returned invalid bus type %d\n", fd.type);
+               return -EINVAL;
+       }
+
+       if (!fd.num_entries) {
+               dev_err(cru->dev, "get_frame_desc returned zero entries\n");
+               return -EINVAL;
+       }
+
+       return fd.entry[0].bus.csi2.vc;
+}
+
 int rzg2l_cru_start_image_processing(struct rzg2l_cru_dev *cru)
 {
        struct v4l2_mbus_framefmt *fmt = rzg2l_cru_ip_get_src_fmt(cru);
        unsigned long flags;
        int ret;
 
+       ret = rzg2l_cru_get_virtual_channel(cru);
+       if (ret < 0)
+               return ret;
+       cru->csi.channel = ret;
+
        spin_lock_irqsave(&cru->qlock, flags);
 
        /* Select a video input */