media: am437x-vpfe: Use a per instance format array instead of a static one

Using a statically defined format array would cause issue when
multiple vpfe instance would be connected to sub-device of
different capabilities. We need to use an instance based array
instead to properly maintain a per port/instance format list.

Signed-off-by: Benoit Parrot <bparrot@ti.com>
Acked-by: Lad Prabhakar <prabhakar.csengg@gmail.com>
Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl>
Signed-off-by: Mauro Carvalho Chehab <mchehab+samsung@kernel.org>

diff --git a/drivers/media/platform/am437x/am437x-vpfe.c b/drivers/media/platform/am437x/am437x-vpfe.c
index 8b218f48428f3924fd6bcc4001fa22a813665015..b213348fd1c41baab9ac64e2b49e7889ad2ac142 100644 (file)
--- a/drivers/media/platform/am437x/am437x-vpfe.c
+++ b/drivers/media/platform/am437x/am437x-vpfe.c
@@ -69,31 +69,7 @@ static const struct vpfe_standard vpfe_standards[] = {
        {V4L2_STD_625_50, 720, 576, {54, 59}, 1},
 };
 
-struct bus_format {
-       unsigned int width;
-       unsigned int bpp;
-};
-
-/*
- * struct vpfe_fmt - VPFE media bus format information
- * @code: V4L2 media bus format code
- * @shifted: V4L2 media bus format code for the same pixel layout but
- *     shifted to be 8 bits per pixel. =0 if format is not shiftable.
- * @pixelformat: V4L2 pixel format FCC identifier
- * @width: Bits per pixel (when transferred over a bus)
- * @bpp: Bytes per pixel (when stored in memory)
- * @supported: Indicates format supported by subdev
- */
-struct vpfe_fmt {
-       u32 fourcc;
-       u32 code;
-       struct bus_format l;
-       struct bus_format s;
-       bool supported;
-       u32 index;
-};
-
-static struct vpfe_fmt formats[] = {
+static struct vpfe_fmt formats[VPFE_NUM_FORMATS] = {
        {
                .fourcc         = V4L2_PIX_FMT_YUYV,
                .code           = MEDIA_BUS_FMT_YUYV8_2X8,
@@ -101,7 +77,6 @@ static struct vpfe_fmt formats[] = {
                .l.bpp          = 4,
                .s.width        = 8,
                .s.bpp          = 2,
-               .supported      = false,
        }, {
                .fourcc         = V4L2_PIX_FMT_UYVY,
                .code           = MEDIA_BUS_FMT_UYVY8_2X8,
@@ -109,7 +84,6 @@ static struct vpfe_fmt formats[] = {
                .l.bpp          = 4,
                .s.width        = 8,
                .s.bpp          = 2,
-               .supported      = false,
        }, {
                .fourcc         = V4L2_PIX_FMT_YVYU,
                .code           = MEDIA_BUS_FMT_YVYU8_2X8,
@@ -117,7 +91,6 @@ static struct vpfe_fmt formats[] = {
                .l.bpp          = 4,
                .s.width        = 8,
                .s.bpp          = 2,
-               .supported      = false,
        }, {
                .fourcc         = V4L2_PIX_FMT_VYUY,
                .code           = MEDIA_BUS_FMT_VYUY8_2X8,
@@ -125,7 +98,6 @@ static struct vpfe_fmt formats[] = {
                .l.bpp          = 4,
                .s.width        = 8,
                .s.bpp          = 2,
-               .supported      = false,
        }, {
                .fourcc         = V4L2_PIX_FMT_SBGGR8,
                .code           = MEDIA_BUS_FMT_SBGGR8_1X8,
@@ -133,7 +105,6 @@ static struct vpfe_fmt formats[] = {
                .l.bpp          = 2,
                .s.width        = 8,
                .s.bpp          = 1,
-               .supported      = false,
        }, {
                .fourcc         = V4L2_PIX_FMT_SGBRG8,
                .code           = MEDIA_BUS_FMT_SGBRG8_1X8,
@@ -141,7 +112,6 @@ static struct vpfe_fmt formats[] = {
                .l.bpp          = 2,
                .s.width        = 8,
                .s.bpp          = 1,
-               .supported      = false,
        }, {
                .fourcc         = V4L2_PIX_FMT_SGRBG8,
                .code           = MEDIA_BUS_FMT_SGRBG8_1X8,
@@ -149,7 +119,6 @@ static struct vpfe_fmt formats[] = {
                .l.bpp          = 2,
                .s.width        = 8,
                .s.bpp          = 1,
-               .supported      = false,
        }, {
                .fourcc         = V4L2_PIX_FMT_SRGGB8,
                .code           = MEDIA_BUS_FMT_SRGGB8_1X8,
@@ -157,7 +126,6 @@ static struct vpfe_fmt formats[] = {
                .l.bpp          = 2,
                .s.width        = 8,
                .s.bpp          = 1,
-               .supported      = false,
        }, {
                .fourcc         = V4L2_PIX_FMT_RGB565,
                .code           = MEDIA_BUS_FMT_RGB565_2X8_LE,
@@ -165,7 +133,6 @@ static struct vpfe_fmt formats[] = {
                .l.bpp          = 4,
                .s.width        = 8,
                .s.bpp          = 2,
-               .supported      = false,
        }, {
                .fourcc         = V4L2_PIX_FMT_RGB565X,
                .code           = MEDIA_BUS_FMT_RGB565_2X8_BE,
@@ -173,7 +140,6 @@ static struct vpfe_fmt formats[] = {
                .l.bpp          = 4,
                .s.width        = 8,
                .s.bpp          = 2,
-               .supported      = false,
        },
 };
 
@@ -181,13 +147,14 @@ static int
 __vpfe_get_format(struct vpfe_device *vpfe,
                  struct v4l2_format *format, unsigned int *bpp);
 
-static struct vpfe_fmt *find_format_by_code(unsigned int code)
+static struct vpfe_fmt *find_format_by_code(struct vpfe_device *vpfe,
+                                           unsigned int code)
 {
        struct vpfe_fmt *fmt;
        unsigned int k;
 
-       for (k = 0; k < ARRAY_SIZE(formats); k++) {
-               fmt = &formats[k];
+       for (k = 0; k < vpfe->num_active_fmt; k++) {
+               fmt = vpfe->active_fmt[k];
                if (fmt->code == code)
                        return fmt;
        }
@@ -195,13 +162,14 @@ static struct vpfe_fmt *find_format_by_code(unsigned int code)
        return NULL;
 }
 
-static struct vpfe_fmt *find_format_by_pix(unsigned int pixelformat)
+static struct vpfe_fmt *find_format_by_pix(struct vpfe_device *vpfe,
+                                          unsigned int pixelformat)
 {
        struct vpfe_fmt *fmt;
        unsigned int k;
 
-       for (k = 0; k < ARRAY_SIZE(formats); k++) {
-               fmt = &formats[k];
+       for (k = 0; k < vpfe->num_active_fmt; k++) {
+               fmt = vpfe->active_fmt[k];
                if (fmt->fourcc == pixelformat)
                        return fmt;
        }
@@ -218,7 +186,7 @@ mbus_to_pix(struct vpfe_device *vpfe,
        unsigned int bus_width = sdinfo->vpfe_param.bus_width;
        struct vpfe_fmt *fmt;
 
-       fmt = find_format_by_code(mbus->code);
+       fmt = find_format_by_code(vpfe, mbus->code);
        if (WARN_ON(fmt == NULL)) {
                pr_err("Invalid mbus code set\n");
                *bpp = 1;
@@ -241,12 +209,12 @@ static void pix_to_mbus(struct vpfe_device *vpfe,
 {
        struct vpfe_fmt *fmt;
 
-       fmt = find_format_by_pix(pix_fmt->pixelformat);
+       fmt = find_format_by_pix(vpfe, pix_fmt->pixelformat);
        if (!fmt) {
                /* default to first entry */
                vpfe_dbg(3, vpfe, "Invalid pixel code: %x, default used instead\n",
                        pix_fmt->pixelformat);
-               fmt = &formats[0];
+               fmt = vpfe->active_fmt[0];
        }
 
        memset(mbus_fmt, 0, sizeof(*mbus_fmt));
@@ -1494,8 +1462,7 @@ static int vpfe_enum_fmt(struct file *file, void  *priv,
 {
        struct vpfe_device *vpfe = video_drvdata(file);
        struct vpfe_subdev_info *sdinfo;
-       struct vpfe_fmt *fmt = NULL;
-       unsigned int k;
+       struct vpfe_fmt *fmt;
 
        vpfe_dbg(2, vpfe, "vpfe_enum_format index:%d\n",
                f->index);
@@ -1504,17 +1471,10 @@ static int vpfe_enum_fmt(struct file *file, void  *priv,
        if (!sdinfo->sd)
                return -EINVAL;
 
-       if (f->index > ARRAY_SIZE(formats))
+       if (f->index >= vpfe->num_active_fmt)
                return -EINVAL;
 
-       for (k = 0; k < ARRAY_SIZE(formats); k++) {
-               if (formats[k].index == f->index) {
-                       fmt = &formats[k];
-                       break;
-               }
-       }
-       if (!fmt)
-               return -EINVAL;
+       fmt = vpfe->active_fmt[f->index];
 
        f->pixelformat = fmt->fourcc;
 
@@ -1593,7 +1553,7 @@ static int vpfe_enum_size(struct file *file, void  *priv,
        vpfe_dbg(2, vpfe, "vpfe_enum_size\n");
 
        /* check for valid format */
-       fmt = find_format_by_pix(fsize->pixel_format);
+       fmt = find_format_by_pix(vpfe, fsize->pixel_format);
        if (!fmt) {
                vpfe_dbg(3, vpfe, "Invalid pixel code: %x, default used instead\n",
                        fsize->pixel_format);
@@ -2281,8 +2241,10 @@ vpfe_async_bound(struct v4l2_async_notifier *notifier,
                                               struct vpfe_device, v4l2_dev);
        struct v4l2_subdev_mbus_code_enum mbus_code;
        struct vpfe_subdev_info *sdinfo;
+       struct vpfe_fmt *fmt;
+       int ret = 0;
        bool found = false;
-       int i, j;
+       int i, j, k;
 
        vpfe_dbg(1, vpfe, "vpfe_async_bound\n");
 
@@ -2304,27 +2266,37 @@ vpfe_async_bound(struct v4l2_async_notifier *notifier,
 
        vpfe->video_dev.tvnorms |= sdinfo->inputs[0].std;
 
-       /* setup the supported formats & indexes */
-       for (j = 0, i = 0; ; ++j) {
-               struct vpfe_fmt *fmt;
-               int ret;
-
+       vpfe->num_active_fmt = 0;
+       for (j = 0, i = 0; (ret != -EINVAL); ++j) {
                memset(&mbus_code, 0, sizeof(mbus_code));
                mbus_code.index = j;
                mbus_code.which = V4L2_SUBDEV_FORMAT_ACTIVE;
                ret = v4l2_subdev_call(subdev, pad, enum_mbus_code,
-                              NULL, &mbus_code);
+                                      NULL, &mbus_code);
                if (ret)
-                       break;
-
-               fmt = find_format_by_code(mbus_code.code);
-               if (!fmt)
                        continue;
 
-               fmt->supported = true;
-               fmt->index = i++;
+               vpfe_dbg(3, vpfe,
+                        "subdev %s: code: %04x idx: %d\n",
+                        subdev->name, mbus_code.code, j);
+
+               for (k = 0; k < ARRAY_SIZE(formats); k++) {
+                       fmt = &formats[k];
+                       if (mbus_code.code != fmt->code)
+                               continue;
+                       vpfe->active_fmt[i] = fmt;
+                       vpfe_dbg(3, vpfe,
+                                "matched fourcc: %s code: %04x idx: %d\n",
+                                print_fourcc(fmt->fourcc), mbus_code.code, i);
+                       vpfe->num_active_fmt = ++i;
+               }
        }
 
+       if (!i) {
+               vpfe_err(vpfe, "No suitable format reported by subdev %s\n",
+                        subdev->name);
+               return -EINVAL;
+       }
        return 0;
 }
 

diff --git a/drivers/media/platform/am437x/am437x-vpfe.h b/drivers/media/platform/am437x/am437x-vpfe.h
index 2dde097802158d2b032eb57f1d3c7643e1631f18..6c7bcb837f4efb081d52e93dd43a4ed42063b367 100644 (file)
--- a/drivers/media/platform/am437x/am437x-vpfe.h
+++ b/drivers/media/platform/am437x/am437x-vpfe.h
@@ -215,6 +215,37 @@ struct vpfe_ccdc {
        u32 ccdc_ctx[VPFE_REG_END / sizeof(u32)];
 };
 
+/*
+ * struct bus_format - VPFE bus format information
+ * width: Bits per pixel (when transferred over a bus)
+ * bpp: Bytes per pixel (when stored in memory)
+ */
+struct bus_format {
+       unsigned int width;
+       unsigned int bpp;
+};
+
+/*
+ * struct vpfe_fmt - VPFE media bus format information
+ * fourcc: V4L2 pixel format code
+ * code: V4L2 media bus format code
+ * l: 10 bit bus format info
+ * s: 8 bit bus format info
+ */
+struct vpfe_fmt {
+       u32 fourcc;
+       u32 code;
+       struct bus_format l;
+       struct bus_format s;
+};
+
+/*
+ * When formats[] is modified make sure to adjust this value also.
+ * Expect compile time warnings if VPFE_NUM_FORMATS is smaller then
+ * the number of elements in formats[].
+ */
+#define VPFE_NUM_FORMATS       10
+
 struct vpfe_device {
        /* V4l2 specific parameters */
        /* Identifies video device for this channel */
@@ -252,6 +283,9 @@ struct vpfe_device {
        struct v4l2_format fmt;
        /* Used to store current bytes per pixel based on current format */
        unsigned int bpp;
+       struct vpfe_fmt *active_fmt[VPFE_NUM_FORMATS];
+       unsigned int num_active_fmt;
+
        /*
         * used when IMP is chained to store the crop window which
         * is different from the image window