Currently the driver ignores MIPI_DSI_MODE_LPM and always uses HS mode.
Add code to enable HS mode in pre_enable() only if MIPI_DSI_MODE_LPM is
not set, and always enable HS mode in enable() for video transmission.

Signed-off-by: Tomi Valkeinen <[email protected]>
---
 drivers/gpu/drm/bridge/tc358768.c | 8 +++++++-
 1 file changed, 7 insertions(+), 1 deletion(-)

diff --git a/drivers/gpu/drm/bridge/tc358768.c 
b/drivers/gpu/drm/bridge/tc358768.c
index a276fbc75dde..a7a14c125ac4 100644
--- a/drivers/gpu/drm/bridge/tc358768.c
+++ b/drivers/gpu/drm/bridge/tc358768.c
@@ -1091,7 +1091,8 @@ static void tc358768_bridge_atomic_pre_enable(struct 
drm_bridge *bridge,
        /* Configure DSI_Control register */
        val = (dsi_dev->lanes - 1) << 1;
 
-       val |= TC358768_DSI_CONTROL_TXMD;
+       if (!(dsi_dev->mode_flags & MIPI_DSI_MODE_LPM))
+               val |= TC358768_DSI_CONTROL_TXMD;
 
        if (!(dsi_dev->mode_flags & MIPI_DSI_CLOCK_NON_CONTINUOUS))
                val |= TC358768_DSI_CONTROL_HSCKMD;
@@ -1123,6 +1124,11 @@ static void tc358768_bridge_atomic_enable(struct 
drm_bridge *bridge,
                return;
        }
 
+       /* Enable HS mode for video TX */
+       tc358768_confw_update_bits(priv, TC358768_DSI_CONTROL,
+                                  TC358768_DSI_CONTROL_TXMD,
+                                  TC358768_DSI_CONTROL_TXMD);
+
        /* clear FrmStop and RstPtr */
        tc358768_update_bits(priv, TC358768_PP_MISC, 0x3 << 14, 0);
 

-- 
2.43.0

Reply via email to