drivers: media: cfe: Add non-continuous CSI-2 clock mode

Set the DPHY block to manual clock lane termination enable and HS mode
i V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK is absent in the bus flags.

Signed-off-by: Naushir Patuck <[email protected]>

Author: naushir

drivers/media/platform/raspberrypi/rp1_cfe/cfe.c

@@ -1156,6 +1156,10 @@ static int cfe_start_streaming(struct vb2_queue *vq, unsigned int count)
 		goto err_pm_put;
 	}
 
+	cfe->csi2.dphy.noncontinuous_clock =
+		(!ret ? mbus_config.bus.mipi_csi2.flags : cfe->csi2.bus_flags) &
+					V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK;
+
 	cfe->csi2.dphy.active_lanes = mbus_config.bus.mipi_csi2.num_data_lanes;
 	if (!cfe->csi2.dphy.active_lanes)
 		cfe->csi2.dphy.active_lanes = cfe->csi2.dphy.max_lanes;

drivers/media/platform/raspberrypi/rp1_cfe/dphy.c

@@ -30,6 +30,7 @@
 #define PHY2_TST_CTRL1	0x05c
 
 /* DW dphy Host Transactions */
+#define DPHY_HS_RX_CTRL_CLK_OFFSET	0x34
 #define DPHY_HS_RX_CTRL_LANE0_OFFSET	0x44
 #define DPHY_PLL_INPUT_DIV_OFFSET	0x17
 #define DPHY_PLL_LOOP_DIV_OFFSET	0x18
@@ -128,6 +129,29 @@ static void dphy_set_hsfreqrange(struct dphy_data *dphy, uint32_t mbps)
 			 hsfreqrange_table[i][1] << 1);
 }
 
+static void dphy_set_clock_term(struct dphy_data *dphy, bool set_auto)
+{
+	/* See page 162 of the dphy databook */
+	const u8 tst_manual = (1 << 0) + /* HS RX power on */
+			      (1 << 1) + /* Bypass HS RX power on */
+			      (1 << 2) + /* HS RX cal enable */
+			      (0 << 3) + /* Bypass HS RX cal */
+			      (1 << 4) + /* Term EN */
+			      (1 << 5) + /* Bypass Term EN control */
+			      (2 << 6);  /* Set 0 */
+
+	const u8 tst_auto = (0 << 0) + /* HS RX power on */
+			    (0 << 1) + /* FSM HS RX power on */
+			    (0 << 2) + /* HS RX cal enable */
+			    (0 << 3) + /* FSM HS RX cal control */
+			    (0 << 4) + /* Term EN */
+			    (0 << 5) + /* FSM Term EN control */
+			    (2 << 6);  /* Set 0 */
+
+	dphy_transaction(dphy, DPHY_HS_RX_CTRL_CLK_OFFSET,
+			 set_auto ? tst_auto : tst_manual);
+}
+
 static void dphy_init(struct dphy_data *dphy)
 {
 	dw_csi2_host_write(dphy, PHY_RSTZ, 0);
@@ -140,6 +164,7 @@ static void dphy_init(struct dphy_data *dphy)
 	usleep_range(15, 20);
 
 	dphy_set_hsfreqrange(dphy, dphy->dphy_rate);
+	dphy_set_clock_term(dphy, dphy->noncontinuous_clock);
 
 	usleep_range(5, 10);
 	dw_csi2_host_write(dphy, PHY_SHUTDOWNZ, 1);

drivers/media/platform/raspberrypi/rp1_cfe/dphy.h

@@ -18,6 +18,7 @@ struct dphy_data {
 	u32 dphy_rate;
 	u32 max_lanes;
 	u32 active_lanes;
+	bool noncontinuous_clock;
 };
 
 void dphy_probe(struct dphy_data *dphy);