This initializes the mipi high speed transmitter CTRL and SYNC
configuration registers.

Signed-off-by: Anitha Chrisanthus <anitha.chrisant...@intel.com>
Reviewed-by: Bob Paauwe <bob.j.paa...@intel.com>
---
 drivers/gpu/drm/kmb/kmb_dsi.c  | 55 ++++++++++++++++++++++++++++++++++++++++--
 drivers/gpu/drm/kmb/kmb_regs.h | 29 +++++++++++++++++++++-
 2 files changed, 81 insertions(+), 3 deletions(-)

diff --git a/drivers/gpu/drm/kmb/kmb_dsi.c b/drivers/gpu/drm/kmb/kmb_dsi.c
index 92a62e5..886a8ac 100644
--- a/drivers/gpu/drm/kmb/kmb_dsi.c
+++ b/drivers/gpu/drm/kmb/kmb_dsi.c
@@ -553,6 +553,55 @@ static void mipi_tx_multichannel_fifo_cfg(u8 active_lanes, 
u8 vchannel_id)
        kmb_set_bit_mipi(MIPI_TXm_HS_MC_FIFO_CTRL_EN(ctrl_no), vchannel_id);
 }
 
+static void mipi_tx_ctrl_cfg(u8 fg_id, struct mipi_ctrl_cfg *ctrl_cfg)
+{
+       u32 sync_cfg = 0, ctrl = 0, fg_en;
+       u32 ctrl_no = MIPI_CTRL6;
+
+       /*MIPI_TX_HS_SYNC_CFG*/
+       if (ctrl_cfg->tx_ctrl_cfg.line_sync_pkt_en)
+               sync_cfg |= LINE_SYNC_PKT_ENABLE;
+       if (ctrl_cfg->tx_ctrl_cfg.frame_counter_active)
+               sync_cfg |= FRAME_COUNTER_ACTIVE;
+       if (ctrl_cfg->tx_ctrl_cfg.line_counter_active)
+               sync_cfg |= LINE_COUNTER_ACTIVE;
+       if (ctrl_cfg->tx_ctrl_cfg.tx_dsi_cfg->v_blanking)
+               sync_cfg |= DSI_V_BLANKING;
+       if (ctrl_cfg->tx_ctrl_cfg.tx_dsi_cfg->hsa_blanking)
+               sync_cfg |= DSI_HSA_BLANKING;
+       if (ctrl_cfg->tx_ctrl_cfg.tx_dsi_cfg->hbp_blanking)
+               sync_cfg |= DSI_HBP_BLANKING;
+       if (ctrl_cfg->tx_ctrl_cfg.tx_dsi_cfg->hfp_blanking)
+               sync_cfg |= DSI_HFP_BLANKING;
+       if (ctrl_cfg->tx_ctrl_cfg.tx_dsi_cfg->sync_pulse_eventn)
+               sync_cfg |= DSI_SYNC_PULSE_EVENTN;
+       if (ctrl_cfg->tx_ctrl_cfg.tx_dsi_cfg->lpm_first_vsa_line)
+               sync_cfg |= DSI_LPM_FIRST_VSA_LINE;
+       if (ctrl_cfg->tx_ctrl_cfg.tx_dsi_cfg->lpm_last_vfp_line)
+               sync_cfg |= DSI_LPM_LAST_VFP_LINE;
+       /* enable frame generator */
+       fg_en = 1 << fg_id;
+       sync_cfg |= FRAME_GEN_EN(fg_en);
+       if (ctrl_cfg->tx_ctrl_cfg.tx_always_use_hact)
+               sync_cfg |= ALWAYS_USE_HACT(fg_en);
+       if (ctrl_cfg->tx_ctrl_cfg.tx_hact_wait_stop)
+               sync_cfg |= HACT_WAIT_STOP(fg_en);
+
+       /* MIPI_TX_HS_CTRL*/
+       ctrl = HS_CTRL_EN | TX_SOURCE; /* type:DSI,source:LCD */
+       if (ctrl_cfg->tx_ctrl_cfg.tx_dsi_cfg->eotp_en)
+               ctrl |= DSI_EOTP_EN;
+       if (ctrl_cfg->tx_ctrl_cfg.tx_dsi_cfg->hfp_blank_en)
+               ctrl |= DSI_CMD_HFP_EN;
+       ctrl |= LCD_VC(fg_id);
+       ctrl |= ACTIVE_LANES(ctrl_cfg->active_lanes - 1);
+       /*67 ns stop time*/
+       ctrl |= HSEXIT_CNT(0x43);
+
+       kmb_write_mipi(MIPI_TXm_HS_SYNC_CFG(ctrl_no), sync_cfg);
+       kmb_write_mipi(MIPI_TXm_HS_CTRL(ctrl_no), ctrl);
+}
+
 static u32 mipi_tx_init_cntrl(struct kmb_drm_private *dev_priv,
                struct mipi_ctrl_cfg *ctrl_cfg)
 {
@@ -596,8 +645,7 @@ static u32 mipi_tx_init_cntrl(struct kmb_drm_private 
*dev_priv,
                /* set frame specific parameters */
                mipi_tx_fg_cfg(dev_priv, frame_id, ctrl_cfg->active_lanes,
                                bits_per_pclk,
-                               word_count,
-                               ctrl_cfg->lane_rate_mbps,
+                               word_count, ctrl_cfg->lane_rate_mbps,
                                ctrl_cfg->tx_ctrl_cfg.frames[frame_id]);
 
                active_vchannels++;
@@ -612,6 +660,9 @@ static u32 mipi_tx_init_cntrl(struct kmb_drm_private 
*dev_priv,
                return -EINVAL;
        /*Multi-Channel FIFO Configuration*/
        mipi_tx_multichannel_fifo_cfg(ctrl_cfg->active_lanes, frame_id);
+
+       /*Frame Generator Enable */
+       mipi_tx_ctrl_cfg(frame_id, ctrl_cfg);
        return ret;
 }
 
diff --git a/drivers/gpu/drm/kmb/kmb_regs.h b/drivers/gpu/drm/kmb/kmb_regs.h
index d6fcead..9a5f371 100644
--- a/drivers/gpu/drm/kmb/kmb_regs.h
+++ b/drivers/gpu/drm/kmb/kmb_regs.h
@@ -398,7 +398,35 @@
 #define MIPI_CTRL_HS_BASE_ADDR                 (0x400)
 
 #define MIPI_TX_HS_CTRL                                (0x0)
+#define   MIPI_TXm_HS_CTRL(M)                  (MIPI_TX_HS_CTRL + (0x400*M))
+#define   HS_CTRL_EN                           (1 << 0)
+#define   HS_CTRL_CSIDSIN                      (1 << 2) /*1:CSI 0:DSI*/
+#define   TX_SOURCE                            (1 << 3) /*1:LCD, 0:DMA*/
+#define   ACTIVE_LANES(n)                      ((n) << 4)
+#define   LCD_VC(ch)                           ((ch) << 8)
+#define   DSI_EOTP_EN                          (1 << 11)
+#define   DSI_CMD_HFP_EN                       (1 << 12)
+#define   CRC_EN                               (1 << 14)
+#define   HSEXIT_CNT(n)                                ((n) << 16)
+#define   HSCLKIDLE_CNT                                (1 << 24)
 #define MIPI_TX_HS_SYNC_CFG                    (0x8)
+#define   MIPI_TXm_HS_SYNC_CFG(M)              (MIPI_TX_HS_SYNC_CFG \
+                                               + (0x400*M))
+#define   LINE_SYNC_PKT_ENABLE                 (1 << 0)
+#define   FRAME_COUNTER_ACTIVE                 (1 << 1)
+#define   LINE_COUNTER_ACTIVE                  (1 << 2)
+#define   DSI_V_BLANKING                       (1 << 4)
+#define   DSI_HSA_BLANKING                     (1 << 5)
+#define   DSI_HBP_BLANKING                     (1 << 6)
+#define   DSI_HFP_BLANKING                     (1 << 7)
+#define   DSI_SYNC_PULSE_EVENTN                        (1 << 8)
+#define   DSI_LPM_FIRST_VSA_LINE               (1 << 9)
+#define   DSI_LPM_LAST_VFP_LINE                        (1 << 10)
+#define   WAIT_ALL_SECT                                (1 << 11)
+#define   WAIT_TRIG_POS                                (1 << 15)
+#define   ALWAYS_USE_HACT(f)                   ((f) << 19)
+#define   FRAME_GEN_EN(f)                      ((f) << 23)
+#define   HACT_WAIT_STOP(f)                    ((f) << 28)
 #define MIPI_TX0_HS_FG0_SECT0_PH               (0x40)
 #define MIPI_TXm_HS_FGn_SECTo_PH(M, N, O)      (MIPI_TX0_HS_FG0_SECT0_PH + \
                                                (0x400*M) + (0x2C*N) + (8*O))
@@ -454,7 +482,6 @@
 #define MIPI_TX_HS_LLP_H_FRONTPORCH0           (0x15c)
 #define MIPI_TXm_HS_LLP_H_FRONTPORCHn(M, N)    (MIPI_TX_HS_LLP_H_FRONTPORCH0 \
                                                + (0x400*M) + (0x4*N))
-
 #define MIPI_TX_HS_MC_FIFO_CTRL_EN             (0x194)
 #define MIPI_TXm_HS_MC_FIFO_CTRL_EN(M)         (MIPI_TX_HS_MC_FIFO_CTRL_EN \
                                                + (0x400*M))
-- 
2.7.4

_______________________________________________
dri-devel mailing list
dri-devel@lists.freedesktop.org
https://lists.freedesktop.org/mailman/listinfo/dri-devel

Reply via email to