From: liuxl0327 <liuxl0327@starfivetech.com>
Date: Mon, 21 Mar 2022 07:19:27 +0000 (+0800)
Subject: v4l2: starfive DVP support multi stream on
X-Git-Url: http://review.tizen.org/git/?a=commitdiff_plain;h=009c4abdd7a22556d3ee04a7358f5c9ba21afbe7;p=platform%2Fkernel%2Flinux-starfive.git

v4l2: starfive DVP support multi stream on

Signed-off-by: mason.huo <mason.huo@starfivetech.com>
---

diff --git a/drivers/media/platform/starfive/v4l2_driver/stf_dvp.c b/drivers/media/platform/starfive/v4l2_driver/stf_dvp.c
old mode 100755
new mode 100644
index 19f977a..f7151fc
--- a/drivers/media/platform/starfive/v4l2_driver/stf_dvp.c
+++ b/drivers/media/platform/starfive/v4l2_driver/stf_dvp.c
@@ -10,15 +10,17 @@
 #include <media/v4l2-fwnode.h>
 #include <media/v4l2-subdev.h>
 
-#define STF_DVP_NAME "stf_dvp"
-
 static const struct dvp_format dvp_formats_st7110[] = {
-	{ MEDIA_BUS_FMT_YUYV8_2X8, 16},
-	{ MEDIA_BUS_FMT_RGB565_2X8_LE, 16},
-	{ MEDIA_BUS_FMT_SRGGB10_1X10, 16},
-	{ MEDIA_BUS_FMT_SGRBG10_1X10, 16},
-	{ MEDIA_BUS_FMT_SGBRG10_1X10, 16},
-	{ MEDIA_BUS_FMT_SBGGR10_1X10, 16},
+	{ MEDIA_BUS_FMT_YUYV8_2X8, 8},
+	{ MEDIA_BUS_FMT_RGB565_2X8_LE, 8},
+	{ MEDIA_BUS_FMT_SRGGB8_1X8, 8},
+	{ MEDIA_BUS_FMT_SGRBG8_1X8, 8},
+	{ MEDIA_BUS_FMT_SGBRG8_1X8, 8},
+	{ MEDIA_BUS_FMT_SBGGR8_1X8, 8},
+	{ MEDIA_BUS_FMT_SRGGB10_1X10, 8},
+	{ MEDIA_BUS_FMT_SGRBG10_1X10, 8},
+	{ MEDIA_BUS_FMT_SGBRG10_1X10, 8},
+	{ MEDIA_BUS_FMT_SBGGR10_1X10, 8},
 };
 
 static int dvp_find_format(u32 code,
@@ -120,12 +122,13 @@ static void dvp_try_format(struct stf_dvp_dev *dvp_dev,
 				break;
 
 		if (i >= dvp_dev->nformats)
-			fmt->code = MEDIA_BUS_FMT_RGB565_2X8_LE;
+			fmt->code = dvp_dev->formats[0].code;
 
 		fmt->width = clamp_t(u32,
-				fmt->width, 1, STFCAMSS_FRAME_MAX_WIDTH);
+				fmt->width, STFCAMSS_FRAME_MIN_WIDTH, STFCAMSS_FRAME_MAX_WIDTH);
 		fmt->height = clamp_t(u32,
-				fmt->height, 1, STFCAMSS_FRAME_MAX_HEIGHT_PIX);
+				fmt->height, STFCAMSS_FRAME_MIN_HEIGHT,
+				STFCAMSS_FRAME_MAX_HEIGHT_PIX);
 
 		fmt->field = V4L2_FIELD_NONE;
 		fmt->colorspace = V4L2_COLORSPACE_SRGB;
@@ -224,8 +227,16 @@ static int dvp_set_format(struct v4l2_subdev *sd,
 	if (format == NULL)
 		return -EINVAL;
 
-	dvp_try_format(dvp_dev, state, fmt->pad, &fmt->format, fmt->which);
-	*format = fmt->format;
+	mutex_lock(&dvp_dev->stream_lock);
+	if (dvp_dev->stream_count) {
+		fmt->format = *format;
+		mutex_unlock(&dvp_dev->stream_lock);
+		goto out;
+	} else {
+		dvp_try_format(dvp_dev, state, fmt->pad, &fmt->format, fmt->which);
+		*format = fmt->format;
+	}
+	mutex_unlock(&dvp_dev->stream_lock);
 
 	/* Propagate the format from sink to source */
 	if (fmt->pad == STF_DVP_PAD_SINK) {
@@ -237,6 +248,7 @@ static int dvp_set_format(struct v4l2_subdev *sd,
 					fmt->which);
 	}
 
+out:
 	return 0;
 }
 
diff --git a/drivers/media/platform/starfive/v4l2_driver/stf_dvp.h b/drivers/media/platform/starfive/v4l2_driver/stf_dvp.h
index 5487e7d..cefafa9 100755
--- a/drivers/media/platform/starfive/v4l2_driver/stf_dvp.h
+++ b/drivers/media/platform/starfive/v4l2_driver/stf_dvp.h
@@ -10,6 +10,8 @@
 #include <media/media-entity.h>
 #include <video/stf-vin.h>
 
+#define STF_DVP_NAME "stf_dvp"
+
 #define STF_DVP_PAD_SINK     0
 #define STF_DVP_PAD_SRC      1
 #define STF_DVP_PADS_NUM     2