media: i2c: imx477: Add selection of (non)continuous clock mode

The register set was always selecting continuous clock mode,
even though all our overlays were saying it should be non-continuous.

Read the configuration from fwnode and configure the sensor
accordingly.

Signed-off-by: Dave Stevenson <[email protected]>

Author: 6by9

drivers/media/i2c/imx477.c

@@ -116,6 +116,8 @@ MODULE_PARM_DESC(trigger_mode, "Set vsync trigger mode: 1=source, 2=sink");
 /* Temperature sensor */
 #define IMX477_REG_TEMP_SEN_CTL		0x0138
 
+#define IMX477_REG_FRAME_BLANKSTOP_CLK	0xE000
+
 /* Embedded metadata stream structure */
 #define IMX477_EMBEDDED_LINE_WIDTH 16384
 #define IMX477_NUM_EMBEDDED_LINES 1
@@ -246,7 +248,6 @@ static const struct imx477_reg mode_common_regs[] = {
 	{0x0136, 0x18},
 	{0x0137, 0x00},
 	{0x0138, 0x01},
-	{0xe000, 0x00},
 	{0xe07a, 0x01},
 	{0x0808, 0x02},
 	{0x4ae9, 0x18},
@@ -1040,6 +1041,11 @@ struct imx477 {
 	/* Streaming on/off */
 	bool streaming;
 
+	/* Flags field from parsing the endpoint - used for (non)continuous
+	 * clock mode
+	 */
+	unsigned int csi2_flags;
+
 	/* Rewrite common registers on stream on? */
 	bool common_regs_written;
 
@@ -1647,6 +1653,12 @@ static int imx477_start_streaming(struct imx477 *imx477)
 				__func__);
 			return ret;
 		}
+
+		imx477_write_reg(imx477, IMX477_REG_FRAME_BLANKSTOP_CLK,
+				 IMX477_REG_VALUE_08BIT,
+				 imx477->csi2_flags & V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK ?
+					1 : 0);
+
 		imx477->common_regs_written = true;
 	}
 
@@ -2082,6 +2094,8 @@ static int imx477_check_hwcfg(struct device *dev, struct imx477 *imx477)
 			goto error_out;
 	}
 
+	imx477->csi2_flags = ep_cfg.bus.mipi_csi2.flags;
+
 	ret = 0;
 
 error_out: