[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-Id: <20250821-95_cam-v3-26-c9286fbb34b9@nxp.com>
Date: Thu, 21 Aug 2025 16:16:01 -0400
From: Frank Li <Frank.Li@....com>
To: Rui Miguel Silva <rmfrfs@...il.com>,
Laurent Pinchart <laurent.pinchart@...asonboard.com>,
Martin Kepplinger <martink@...teo.de>, Purism Kernel Team <kernel@...i.sm>,
Mauro Carvalho Chehab <mchehab@...nel.org>, Rob Herring <robh@...nel.org>,
Krzysztof Kozlowski <krzk+dt@...nel.org>,
Conor Dooley <conor+dt@...nel.org>,
Eugen Hristev <eugen.hristev@...aro.org>, Shawn Guo <shawnguo@...nel.org>,
Sascha Hauer <s.hauer@...gutronix.de>,
Pengutronix Kernel Team <kernel@...gutronix.de>,
Fabio Estevam <festevam@...il.com>, Peng Fan <peng.fan@....com>,
Alice Yuan <alice.yuan@....com>, Vinod Koul <vkoul@...nel.org>,
Kishon Vijay Abraham I <kishon@...nel.org>,
Philipp Zabel <p.zabel@...gutronix.de>,
Steve Longerbeam <slongerbeam@...il.com>,
Greg Kroah-Hartman <gregkh@...uxfoundation.org>
Cc: linux-media@...r.kernel.org, devicetree@...r.kernel.org,
linux-kernel@...r.kernel.org, imx@...ts.linux.dev,
linux-arm-kernel@...ts.infradead.org, linux-phy@...ts.infradead.org,
linux-staging@...ts.linux.dev, Frank Li <Frank.Li@....com>
Subject: [PATCH v3 26/31] media: synopsys: csi2: Add v150 lane stop state
register bit define
v150 move lane stop state into new register phy_stopstate and field
position also changed.
Signed-off-by: Frank Li <Frank.Li@....com>
---
drivers/media/platform/synopsys/mipi-csi2.c | 40 +++++++++++++++++++++++++++--
1 file changed, 38 insertions(+), 2 deletions(-)
diff --git a/drivers/media/platform/synopsys/mipi-csi2.c b/drivers/media/platform/synopsys/mipi-csi2.c
index 0b3bb099329017e81d2fb41387a3671e429dfe1c..7225285c772edf6ca3372408dd3cb0637b47e0c0 100644
--- a/drivers/media/platform/synopsys/mipi-csi2.c
+++ b/drivers/media/platform/synopsys/mipi-csi2.c
@@ -31,6 +31,7 @@ struct dw_csi2_regs {
u32 dphy_rstz;
u32 resetn;
u32 phy_state;
+ u32 phy_stopstate;
u32 data_ids_1;
u32 data_ids_2;
u32 err1;
@@ -86,6 +87,7 @@ static const struct dw_csi2_regs dw_csi2_v150 = {
.phy_shutdownz = DW_REG(0x40),
.dphy_rstz = DW_REG(0x44),
.phy_state = DW_REG(0x48),
+ .phy_stopstate = DW_REG(0x4c),
.phy_tst_ctrl0 = DW_REG(0x50),
.phy_tst_ctrl1 = DW_REG(0x54),
.int_st_dphy_fatal = DW_REG(0xe0),
@@ -147,10 +149,13 @@ readl((csi2)->base + ((csi2)->regs->__name & ~DW_REG_EXIST)) : \
dw_csi2_reg_err(csi2, #__name))
#define PHY_STATE_STOPSTATEDATA_BIT 4
+#define PHY_STATE_STOPSTATEDATA_BIT_V150 0
#define PHY_STATE_STOPSTATEDATA(n) BIT(PHY_STATE_STOPSTATEDATA_BIT + (n))
#define PHY_STATE_RXCLKACTIVEHS BIT(8)
+#define PHY_STATE_RXCLKACTIVEHS_V150 BIT(17)
#define PHY_STATE_RXULPSCLKNOT BIT(9)
#define PHY_STATE_STOPSTATECLK BIT(10)
+#define PHY_STATE_STOPSTATECLK_V150 BIT(16)
#define DPHY_TEST_CTRL0_TEST_CLR BIT(0)
#define DPHY_TEST_CTRL0_TEST_CLKEN BIT(1)
@@ -289,7 +294,8 @@ static int __maybe_unused csi2_dphy_wait_ulp(struct dw_mipi_csi2_dev *csi2)
}
/* Waits for low-power LP-11 state on data and clock lanes. */
-static void csi2_dphy_wait_stopstate(struct dw_mipi_csi2_dev *csi2, unsigned int lanes)
+static void csi2_dphy_wait_stopstate_v0(struct dw_mipi_csi2_dev *csi2,
+ unsigned int lanes)
{
u32 mask, reg;
int ret;
@@ -303,13 +309,43 @@ static void csi2_dphy_wait_stopstate(struct dw_mipi_csi2_dev *csi2, unsigned int
}
}
+static void csi2_dphy_wait_stopstate_v150(struct dw_mipi_csi2_dev *csi2,
+ unsigned int lanes)
+{
+ u32 mask, reg;
+ int ret;
+
+ mask = PHY_STATE_STOPSTATECLK_V150 | (((1 << lanes) - 1) <<
+ PHY_STATE_STOPSTATEDATA_BIT_V150);
+
+ ret = read_poll_timeout(dw_readl, reg, (reg & mask) == mask, 0, 500000,
+ 0, csi2, phy_stopstate);
+ if (ret) {
+ v4l2_warn(&csi2->sd, "LP-11 wait timeout, likely a sensor driver bug, expect capture failures.\n");
+ v4l2_warn(&csi2->sd, "phy_state = 0x%08x\n", reg);
+ }
+}
+
+static void csi2_dphy_wait_stopstate(struct dw_mipi_csi2_dev *csi2,
+ unsigned int lanes)
+{
+ if (csi2->regs == &dw_csi2_v0)
+ return csi2_dphy_wait_stopstate_v0(csi2, lanes);
+
+ csi2_dphy_wait_stopstate_v150(csi2, lanes);
+}
+
/* Wait for active clock on the clock lane. */
static int csi2_dphy_wait_clock_lane(struct dw_mipi_csi2_dev *csi2)
{
+ u32 mask;
u32 reg;
int ret;
- ret = read_poll_timeout(dw_readl, reg, (reg & PHY_STATE_RXCLKACTIVEHS),
+ mask = csi2->regs == &dw_csi2_v0 ? PHY_STATE_RXCLKACTIVEHS :
+ PHY_STATE_RXCLKACTIVEHS_V150;
+
+ ret = read_poll_timeout(dw_readl, reg, (reg & mask),
0, 500000, 0, csi2, phy_state);
if (ret) {
v4l2_err(&csi2->sd, "clock lane timeout, phy_state = 0x%08x\n",
--
2.34.1
Powered by blists - more mailing lists