[PATCH v3 04/13] [media] mtk-mipicsi: add the check for non-supported color format

[Stu Hsieh]

This patch add the check for non-supported color format

Signed-off-by: Stu Hsieh <stu.hs...@mediatek.com>
---
 .../media/platform/mtk-mipicsi/mtk_mipicsi.c  | 20 +++++++++++++++++++
 1 file changed, 20 insertions(+)

diff --git a/drivers/media/platform/mtk-mipicsi/mtk_mipicsi.c 
b/drivers/media/platform/mtk-mipicsi/mtk_mipicsi.c
index 9142564baf1d..9c65b96456c4 100644
--- a/drivers/media/platform/mtk-mipicsi/mtk_mipicsi.c
+++ b/drivers/media/platform/mtk-mipicsi/mtk_mipicsi.c
@@ -172,6 +172,20 @@ static void mtk_mipicsi_remove_device(struct 
soc_camera_device *icd)
        (void)pm_runtime_put_sync(icd->parent);
 }
 
+static bool is_supported(const u32 pixformat)
+{
+       switch (pixformat) {
+       /* YUV422 */
+       case V4L2_PIX_FMT_YUYV:
+       case V4L2_PIX_FMT_UYVY:
+       case V4L2_PIX_FMT_YVYU:
+       case V4L2_PIX_FMT_VYUY:
+               return true;
+       }
+
+       return false;
+}
+
 static int mtk_mipicsi_set_fmt(struct soc_camera_device *icd,
                                struct v4l2_format *f)
 {
@@ -187,6 +201,12 @@ static int mtk_mipicsi_set_fmt(struct soc_camera_device 
*icd,
        struct v4l2_mbus_framefmt *mf = &format.format;
        int ret = 0;
 
+       if (!is_supported(pix->pixelformat)) {
+               dev_err(dev, "Format %x not support. set V4L2_PIX_FMT_YUYV as 
default\n",
+                       pix->pixelformat);
+               pix->pixelformat = V4L2_PIX_FMT_YUYV;
+       }
+
        xlate = soc_camera_xlate_by_fourcc(icd, pix->pixelformat);
        if (xlate == NULL) {
                dev_err(dev, "Format 0x%x not found\n", pix->pixelformat);
-- 
2.18.0