Hi Tomi,
On Tue, Apr 26, 2022 at 10:02:40AM +0300, Tomi Valkeinen wrote:
> Use get_frame_desc() to get the frame desc from the connected source,
> and use the provided virtual channel and datatype instead of hardcoded
> ones.
>
> get_frame_desc() can contain multiple streams, but as we don't support
> multiple streams yet, we will just always use the first stream.
>
> If the source doesn't support get_frame_desc(), fall back to the
> previous method of always capturing virtual channel 0 and any datatype.
>
> Signed-off-by: Tomi Valkeinen <tomi.valkeinen@xxxxxxxxxxxxxxxx>
Reviewed-by: Jacopo Mondi <jacopo@xxxxxxxxxx>
Thanks
j
> ---
> drivers/media/platform/ti/cal/cal-camerarx.c | 27 +++++++++++
> drivers/media/platform/ti/cal/cal.c | 49 +++++++++++++++++++-
> drivers/media/platform/ti/cal/cal.h | 2 +
> 3 files changed, 76 insertions(+), 2 deletions(-)
>
> diff --git a/drivers/media/platform/ti/cal/cal-camerarx.c b/drivers/media/platform/ti/cal/cal-camerarx.c
> index 6b43a1525b45..e69fed117fea 100644
> --- a/drivers/media/platform/ti/cal/cal-camerarx.c
> +++ b/drivers/media/platform/ti/cal/cal-camerarx.c
> @@ -583,6 +583,33 @@ static int cal_camerarx_parse_dt(struct cal_camerarx *phy)
> return ret;
> }
>
> +int cal_camerarx_get_remote_frame_desc(struct cal_camerarx *phy,
> + struct v4l2_mbus_frame_desc *desc)
> +{
> + struct media_pad *pad;
> + int ret;
> +
> + if (!phy->source)
> + return -EPIPE;
> +
> + pad = media_entity_remote_pad(&phy->pads[CAL_CAMERARX_PAD_SINK]);
> + if (!pad)
> + return -EPIPE;
> +
> + ret = v4l2_subdev_call(phy->source, pad, get_frame_desc, pad->index,
> + desc);
> + if (ret)
> + return ret;
> +
> + if (desc->type != V4L2_MBUS_FRAME_DESC_TYPE_CSI2) {
> + dev_err(phy->cal->dev,
> + "Frame descriptor does not describe CSI-2 link");
> + return -EINVAL;
> + }
> +
> + return 0;
> +}
> +
> /* ------------------------------------------------------------------
> * V4L2 Subdev Operations
> * ------------------------------------------------------------------
> diff --git a/drivers/media/platform/ti/cal/cal.c b/drivers/media/platform/ti/cal/cal.c
> index 4a4a6c5983f7..df66b8192349 100644
> --- a/drivers/media/platform/ti/cal/cal.c
> +++ b/drivers/media/platform/ti/cal/cal.c
> @@ -469,10 +469,57 @@ static bool cal_ctx_wr_dma_stopped(struct cal_ctx *ctx)
> return stopped;
> }
>
> +static int
> +cal_get_remote_frame_desc_entry(struct cal_camerarx *phy,
> + struct v4l2_mbus_frame_desc_entry *entry)
> +{
> + struct v4l2_mbus_frame_desc fd;
> + int ret;
> +
> + ret = cal_camerarx_get_remote_frame_desc(phy, &fd);
> + if (ret) {
> + if (ret != -ENOIOCTLCMD)
> + dev_err(phy->cal->dev,
> + "Failed to get remote frame desc: %d\n", ret);
> + return ret;
> + }
> +
> + if (fd.num_entries == 0) {
> + dev_err(phy->cal->dev,
> + "No streams found in the remote frame descriptor\n");
> +
> + return -ENODEV;
> + }
> +
> + if (fd.num_entries > 1)
> + dev_dbg(phy->cal->dev,
> + "Multiple streams not supported in remote frame descriptor, using the first one\n");
> +
> + *entry = fd.entry[0];
> +
> + return 0;
> +}
> +
> int cal_ctx_prepare(struct cal_ctx *ctx)
> {
> + struct v4l2_mbus_frame_desc_entry entry;
> int ret;
>
> + ret = cal_get_remote_frame_desc_entry(ctx->phy, &entry);
> +
> + if (ret == -ENOIOCTLCMD) {
> + ctx->vc = 0;
> + ctx->datatype = CAL_CSI2_CTX_DT_ANY;
> + } else if (!ret) {
> + ctx_dbg(2, ctx, "Framedesc: len %u, vc %u, dt %#x\n",
> + entry.length, entry.bus.csi2.vc, entry.bus.csi2.dt);
> +
> + ctx->vc = entry.bus.csi2.vc;
> + ctx->datatype = entry.bus.csi2.dt;
> + } else {
> + return ret;
> + }
> +
> ctx->use_pix_proc = !ctx->fmtinfo->meta;
>
> if (ctx->use_pix_proc) {
> @@ -936,8 +983,6 @@ static struct cal_ctx *cal_ctx_create(struct cal_dev *cal, int inst)
> ctx->dma_ctx = inst;
> ctx->csi2_ctx = inst;
> ctx->cport = inst;
> - ctx->vc = 0;
> - ctx->datatype = CAL_CSI2_CTX_DT_ANY;
>
> ret = cal_ctx_v4l2_init(ctx);
> if (ret)
> diff --git a/drivers/media/platform/ti/cal/cal.h b/drivers/media/platform/ti/cal/cal.h
> index 527e22d022f3..61409ddced98 100644
> --- a/drivers/media/platform/ti/cal/cal.h
> +++ b/drivers/media/platform/ti/cal/cal.h
> @@ -323,6 +323,8 @@ const struct cal_format_info *cal_format_by_code(u32 code);
>
> void cal_quickdump_regs(struct cal_dev *cal);
>
> +int cal_camerarx_get_remote_frame_desc(struct cal_camerarx *phy,
> + struct v4l2_mbus_frame_desc *desc);
> void cal_camerarx_disable(struct cal_camerarx *phy);
> void cal_camerarx_i913_errata(struct cal_camerarx *phy);
> struct cal_camerarx *cal_camerarx_create(struct cal_dev *cal,
> --
> 2.34.1
>
