189 lines
6.6 KiB
Diff
189 lines
6.6 KiB
Diff
From 1ad48331b7697e4fbc9f4bd376fc2db342045cb6 Mon Sep 17 00:00:00 2001
|
|
From: Dave Stevenson <dave.stevenson@raspberrypi.com>
|
|
Date: Wed, 10 Feb 2021 18:46:22 +0000
|
|
Subject: [PATCH] drm/vc4: Fix dsi0 interrupt support.
|
|
|
|
DSI0 seemingly had very little or no testing as a load of
|
|
the register mappings were incorrect/missing, so host
|
|
transfers always timed out due to enabling/checking incorrect
|
|
bits in the interrupt enable and status registers.
|
|
|
|
Signed-off-by: Dave Stevenson <dave.stevenson@raspberrypi.com>
|
|
---
|
|
drivers/gpu/drm/vc4/vc4_dsi.c | 111 ++++++++++++++++++++++++++--------
|
|
1 file changed, 85 insertions(+), 26 deletions(-)
|
|
|
|
--- a/drivers/gpu/drm/vc4/vc4_dsi.c
|
|
+++ b/drivers/gpu/drm/vc4/vc4_dsi.c
|
|
@@ -181,8 +181,50 @@
|
|
|
|
#define DSI0_TXPKT_PIX_FIFO 0x20 /* AKA PIX_FIFO */
|
|
|
|
-#define DSI0_INT_STAT 0x24
|
|
-#define DSI0_INT_EN 0x28
|
|
+#define DSI0_INT_STAT 0x24
|
|
+#define DSI0_INT_EN 0x28
|
|
+# define DSI0_INT_FIFO_ERR BIT(25)
|
|
+# define DSI0_INT_CMDC_DONE_MASK VC4_MASK(24, 23)
|
|
+# define DSI0_INT_CMDC_DONE_SHIFT 23
|
|
+# define DSI0_INT_CMDC_DONE_NO_REPEAT 1
|
|
+# define DSI0_INT_CMDC_DONE_REPEAT 3
|
|
+# define DSI0_INT_PHY_DIR_RTF BIT(22)
|
|
+# define DSI0_INT_PHY_D1_ULPS BIT(21)
|
|
+# define DSI0_INT_PHY_D1_STOP BIT(20)
|
|
+# define DSI0_INT_PHY_RXLPDT BIT(19)
|
|
+# define DSI0_INT_PHY_RXTRIG BIT(18)
|
|
+# define DSI0_INT_PHY_D0_ULPS BIT(17)
|
|
+# define DSI0_INT_PHY_D0_LPDT BIT(16)
|
|
+# define DSI0_INT_PHY_D0_FTR BIT(15)
|
|
+# define DSI0_INT_PHY_D0_STOP BIT(14)
|
|
+/* Signaled when the clock lane enters the given state. */
|
|
+# define DSI0_INT_PHY_CLK_ULPS BIT(13)
|
|
+# define DSI0_INT_PHY_CLK_HS BIT(12)
|
|
+# define DSI0_INT_PHY_CLK_FTR BIT(11)
|
|
+/* Signaled on timeouts */
|
|
+# define DSI0_INT_PR_TO BIT(10)
|
|
+# define DSI0_INT_TA_TO BIT(9)
|
|
+# define DSI0_INT_LPRX_TO BIT(8)
|
|
+# define DSI0_INT_HSTX_TO BIT(7)
|
|
+/* Contention on a line when trying to drive the line low */
|
|
+# define DSI0_INT_ERR_CONT_LP1 BIT(6)
|
|
+# define DSI0_INT_ERR_CONT_LP0 BIT(5)
|
|
+/* Control error: incorrect line state sequence on data lane 0. */
|
|
+# define DSI0_INT_ERR_CONTROL BIT(4)
|
|
+# define DSI0_INT_ERR_SYNC_ESC BIT(3)
|
|
+# define DSI0_INT_RX2_PKT BIT(2)
|
|
+# define DSI0_INT_RX1_PKT BIT(1)
|
|
+# define DSI0_INT_CMD_PKT BIT(0)
|
|
+
|
|
+#define DSI0_INTERRUPTS_ALWAYS_ENABLED (DSI0_INT_ERR_SYNC_ESC | \
|
|
+ DSI0_INT_ERR_CONTROL | \
|
|
+ DSI0_INT_ERR_CONT_LP0 | \
|
|
+ DSI0_INT_ERR_CONT_LP1 | \
|
|
+ DSI0_INT_HSTX_TO | \
|
|
+ DSI0_INT_LPRX_TO | \
|
|
+ DSI0_INT_TA_TO | \
|
|
+ DSI0_INT_PR_TO)
|
|
+
|
|
# define DSI1_INT_PHY_D3_ULPS BIT(30)
|
|
# define DSI1_INT_PHY_D3_STOP BIT(29)
|
|
# define DSI1_INT_PHY_D2_ULPS BIT(28)
|
|
@@ -894,6 +936,9 @@ static void vc4_dsi_encoder_enable(struc
|
|
|
|
DSI_PORT_WRITE(PHY_AFEC0, afec0);
|
|
|
|
+ /* AFEC reset hold time */
|
|
+ mdelay(1);
|
|
+
|
|
DSI_PORT_WRITE(PHY_AFEC1,
|
|
VC4_SET_FIELD(6, DSI0_PHY_AFEC1_IDR_DLANE1) |
|
|
VC4_SET_FIELD(6, DSI0_PHY_AFEC1_IDR_DLANE0) |
|
|
@@ -1060,12 +1105,9 @@ static void vc4_dsi_encoder_enable(struc
|
|
DSI_PORT_WRITE(CTRL, DSI_PORT_READ(CTRL) | DSI1_CTRL_EN);
|
|
|
|
/* Bring AFE out of reset. */
|
|
- if (dsi->variant->port == 0) {
|
|
- } else {
|
|
- DSI_PORT_WRITE(PHY_AFEC0,
|
|
- DSI_PORT_READ(PHY_AFEC0) &
|
|
- ~DSI1_PHY_AFEC0_RESET);
|
|
- }
|
|
+ DSI_PORT_WRITE(PHY_AFEC0,
|
|
+ DSI_PORT_READ(PHY_AFEC0) &
|
|
+ ~DSI_PORT_BIT(PHY_AFEC0_RESET));
|
|
|
|
vc4_dsi_ulps(dsi, false);
|
|
|
|
@@ -1184,13 +1226,28 @@ static ssize_t vc4_dsi_host_transfer(str
|
|
/* Enable the appropriate interrupt for the transfer completion. */
|
|
dsi->xfer_result = 0;
|
|
reinit_completion(&dsi->xfer_completion);
|
|
- DSI_PORT_WRITE(INT_STAT, DSI1_INT_TXPKT1_DONE | DSI1_INT_PHY_DIR_RTF);
|
|
- if (msg->rx_len) {
|
|
- DSI_PORT_WRITE(INT_EN, (DSI1_INTERRUPTS_ALWAYS_ENABLED |
|
|
- DSI1_INT_PHY_DIR_RTF));
|
|
+ if (dsi->variant->port == 0) {
|
|
+ DSI_PORT_WRITE(INT_STAT,
|
|
+ DSI0_INT_CMDC_DONE_MASK | DSI1_INT_PHY_DIR_RTF);
|
|
+ if (msg->rx_len) {
|
|
+ DSI_PORT_WRITE(INT_EN, (DSI0_INTERRUPTS_ALWAYS_ENABLED |
|
|
+ DSI0_INT_PHY_DIR_RTF));
|
|
+ } else {
|
|
+ DSI_PORT_WRITE(INT_EN,
|
|
+ (DSI0_INTERRUPTS_ALWAYS_ENABLED |
|
|
+ VC4_SET_FIELD(DSI0_INT_CMDC_DONE_NO_REPEAT,
|
|
+ DSI0_INT_CMDC_DONE)));
|
|
+ }
|
|
} else {
|
|
- DSI_PORT_WRITE(INT_EN, (DSI1_INTERRUPTS_ALWAYS_ENABLED |
|
|
- DSI1_INT_TXPKT1_DONE));
|
|
+ DSI_PORT_WRITE(INT_STAT,
|
|
+ DSI1_INT_TXPKT1_DONE | DSI1_INT_PHY_DIR_RTF);
|
|
+ if (msg->rx_len) {
|
|
+ DSI_PORT_WRITE(INT_EN, (DSI1_INTERRUPTS_ALWAYS_ENABLED |
|
|
+ DSI1_INT_PHY_DIR_RTF));
|
|
+ } else {
|
|
+ DSI_PORT_WRITE(INT_EN, (DSI1_INTERRUPTS_ALWAYS_ENABLED |
|
|
+ DSI1_INT_TXPKT1_DONE));
|
|
+ }
|
|
}
|
|
|
|
/* Send the packet. */
|
|
@@ -1207,7 +1264,7 @@ static ssize_t vc4_dsi_host_transfer(str
|
|
ret = dsi->xfer_result;
|
|
}
|
|
|
|
- DSI_PORT_WRITE(INT_EN, DSI1_INTERRUPTS_ALWAYS_ENABLED);
|
|
+ DSI_PORT_WRITE(INT_EN, DSI_PORT_BIT(INTERRUPTS_ALWAYS_ENABLED));
|
|
|
|
if (ret)
|
|
goto reset_fifo_and_return;
|
|
@@ -1253,7 +1310,7 @@ reset_fifo_and_return:
|
|
DSI_PORT_BIT(CTRL_RESET_FIFOS));
|
|
|
|
DSI_PORT_WRITE(TXPKT1C, 0);
|
|
- DSI_PORT_WRITE(INT_EN, DSI1_INTERRUPTS_ALWAYS_ENABLED);
|
|
+ DSI_PORT_WRITE(INT_EN, DSI_PORT_BIT(INTERRUPTS_ALWAYS_ENABLED));
|
|
return ret;
|
|
}
|
|
|
|
@@ -1386,26 +1443,28 @@ static irqreturn_t vc4_dsi_irq_handler(i
|
|
DSI_PORT_WRITE(INT_STAT, stat);
|
|
|
|
dsi_handle_error(dsi, &ret, stat,
|
|
- DSI1_INT_ERR_SYNC_ESC, "LPDT sync");
|
|
+ DSI_PORT_BIT(INT_ERR_SYNC_ESC), "LPDT sync");
|
|
dsi_handle_error(dsi, &ret, stat,
|
|
- DSI1_INT_ERR_CONTROL, "data lane 0 sequence");
|
|
+ DSI_PORT_BIT(INT_ERR_CONTROL), "data lane 0 sequence");
|
|
dsi_handle_error(dsi, &ret, stat,
|
|
- DSI1_INT_ERR_CONT_LP0, "LP0 contention");
|
|
+ DSI_PORT_BIT(INT_ERR_CONT_LP0), "LP0 contention");
|
|
dsi_handle_error(dsi, &ret, stat,
|
|
- DSI1_INT_ERR_CONT_LP1, "LP1 contention");
|
|
+ DSI_PORT_BIT(INT_ERR_CONT_LP1), "LP1 contention");
|
|
dsi_handle_error(dsi, &ret, stat,
|
|
- DSI1_INT_HSTX_TO, "HSTX timeout");
|
|
+ DSI_PORT_BIT(INT_HSTX_TO), "HSTX timeout");
|
|
dsi_handle_error(dsi, &ret, stat,
|
|
- DSI1_INT_LPRX_TO, "LPRX timeout");
|
|
+ DSI_PORT_BIT(INT_LPRX_TO), "LPRX timeout");
|
|
dsi_handle_error(dsi, &ret, stat,
|
|
- DSI1_INT_TA_TO, "turnaround timeout");
|
|
+ DSI_PORT_BIT(INT_TA_TO), "turnaround timeout");
|
|
dsi_handle_error(dsi, &ret, stat,
|
|
- DSI1_INT_PR_TO, "peripheral reset timeout");
|
|
+ DSI_PORT_BIT(INT_PR_TO), "peripheral reset timeout");
|
|
|
|
- if (stat & (DSI1_INT_TXPKT1_DONE | DSI1_INT_PHY_DIR_RTF)) {
|
|
+ if (stat & ((dsi->variant->port ? DSI1_INT_TXPKT1_DONE :
|
|
+ DSI0_INT_CMDC_DONE_MASK) |
|
|
+ DSI_PORT_BIT(INT_PHY_DIR_RTF))) {
|
|
complete(&dsi->xfer_completion);
|
|
ret = IRQ_HANDLED;
|
|
- } else if (stat & DSI1_INT_HSTX_TO) {
|
|
+ } else if (stat & DSI_PORT_BIT(INT_HSTX_TO)) {
|
|
complete(&dsi->xfer_completion);
|
|
dsi->xfer_result = -ETIMEDOUT;
|
|
ret = IRQ_HANDLED;
|