blob: 449b97677788132dd6b9eb654732896756a3ff47 [file] [log] [blame]
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +02001// SPDX-License-Identifier: GPL-2.0
2/*
3 * Copyright (c) 2017, The Linux Foundation. All rights reserved.
4 * Copyright (C) 2023-2024 Linaro Limited
5 * Authors:
6 * - Bhupesh Sharma <bhupesh.sharma@linaro.org>
7 * - Neil Armstrong <neil.armstrong@linaro.org>
8 *
9 * Based on Linux driver
10 */
11
12#include <clk.h>
13#include <clk-uclass.h>
14#include <dm.h>
15#include <dm/device_compat.h>
16#include <dm/devres.h>
17#include <generic-phy.h>
18#include <malloc.h>
19#include <reset.h>
20
21#include <asm/io.h>
22#include <linux/bitops.h>
23#include <linux/clk-provider.h>
24#include <linux/delay.h>
25#include <linux/iopoll.h>
26#include <linux/ioport.h>
27
28#include "phy-qcom-qmp.h"
29#include "phy-qcom-qmp-pcs-ufs-v2.h"
30#include "phy-qcom-qmp-pcs-ufs-v3.h"
31#include "phy-qcom-qmp-pcs-ufs-v4.h"
32#include "phy-qcom-qmp-pcs-ufs-v5.h"
33#include "phy-qcom-qmp-pcs-ufs-v6.h"
34
35#include "phy-qcom-qmp-qserdes-com-v4.h"
Varadarajan Narayananbcf49ae2025-01-10 10:38:15 +053036#include "phy-qcom-qmp-qserdes-com-v5.h"
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +020037#include "phy-qcom-qmp-qserdes-com-v6.h"
38#include "phy-qcom-qmp-qserdes-txrx-v4.h"
Varadarajan Narayananbcf49ae2025-01-10 10:38:15 +053039#include "phy-qcom-qmp-qserdes-txrx-v5.h"
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +020040#include "phy-qcom-qmp-qserdes-txrx-ufs-v6.h"
41
42/* QPHY_SW_RESET bit */
43#define SW_RESET BIT(0)
44/* QPHY_POWER_DOWN_CONTROL */
45#define SW_PWRDN BIT(0)
46/* QPHY_START_CONTROL bits */
47#define SERDES_START BIT(0)
48#define PCS_START BIT(1)
49/* QPHY_PCS_READY_STATUS bit */
50#define PCS_READY BIT(0)
51
52#define PHY_INIT_COMPLETE_TIMEOUT (200 * 10000)
53
54struct qmp_ufs_init_tbl {
55 unsigned int offset;
56 unsigned int val;
57 /*
58 * mask of lanes for which this register is written
59 * for cases when second lane needs different values
60 */
61 u8 lane_mask;
62};
63
64#define QMP_PHY_INIT_CFG(o, v) \
65 { \
66 .offset = o, \
67 .val = v, \
68 .lane_mask = 0xff, \
69 }
70
71#define QMP_PHY_INIT_CFG_LANE(o, v, l) \
72 { \
73 .offset = o, \
74 .val = v, \
75 .lane_mask = l, \
76 }
77
78/* set of registers with offsets different per-PHY */
79enum qphy_reg_layout {
80 /* PCS registers */
81 QPHY_SW_RESET,
82 QPHY_START_CTRL,
83 QPHY_PCS_READY_STATUS,
84 QPHY_PCS_POWER_DOWN_CONTROL,
85 /* Keep last to ensure regs_layout arrays are properly initialized */
86 QPHY_LAYOUT_SIZE
87};
88
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +020089static const unsigned int ufsphy_v3_regs_layout[QPHY_LAYOUT_SIZE] = {
90 [QPHY_START_CTRL] = QPHY_V3_PCS_UFS_PHY_START,
91 [QPHY_PCS_READY_STATUS] = QPHY_V3_PCS_UFS_READY_STATUS,
92 [QPHY_PCS_POWER_DOWN_CONTROL] = QPHY_V3_PCS_UFS_POWER_DOWN_CONTROL,
93};
94
95static const unsigned int ufsphy_v4_regs_layout[QPHY_LAYOUT_SIZE] = {
96 [QPHY_START_CTRL] = QPHY_V4_PCS_UFS_PHY_START,
97 [QPHY_PCS_READY_STATUS] = QPHY_V4_PCS_UFS_READY_STATUS,
98 [QPHY_SW_RESET] = QPHY_V4_PCS_UFS_SW_RESET,
99 [QPHY_PCS_POWER_DOWN_CONTROL] = QPHY_V4_PCS_UFS_POWER_DOWN_CONTROL,
100};
101
Varadarajan Narayananbcf49ae2025-01-10 10:38:15 +0530102static const unsigned int ufsphy_v5_regs_layout[QPHY_LAYOUT_SIZE] = {
103 [QPHY_START_CTRL] = QPHY_V5_PCS_UFS_PHY_START,
104 [QPHY_PCS_READY_STATUS] = QPHY_V5_PCS_UFS_READY_STATUS,
105 [QPHY_SW_RESET] = QPHY_V5_PCS_UFS_SW_RESET,
106 [QPHY_PCS_POWER_DOWN_CONTROL] = QPHY_V5_PCS_UFS_POWER_DOWN_CONTROL,
107};
108
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +0200109static const unsigned int ufsphy_v6_regs_layout[QPHY_LAYOUT_SIZE] = {
110 [QPHY_START_CTRL] = QPHY_V6_PCS_UFS_PHY_START,
111 [QPHY_PCS_READY_STATUS] = QPHY_V6_PCS_UFS_READY_STATUS,
112 [QPHY_SW_RESET] = QPHY_V6_PCS_UFS_SW_RESET,
113 [QPHY_PCS_POWER_DOWN_CONTROL] = QPHY_V6_PCS_UFS_POWER_DOWN_CONTROL,
114};
115
116static const struct qmp_ufs_init_tbl sdm845_ufsphy_serdes[] = {
117 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYS_CLK_CTRL, 0x02),
118 QMP_PHY_INIT_CFG(QSERDES_V3_COM_BIAS_EN_CLKBUFLR_EN, 0x04),
119 QMP_PHY_INIT_CFG(QSERDES_V3_COM_BG_TIMER, 0x0a),
120 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_IVCO, 0x07),
121 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CMN_CONFIG, 0x06),
122 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_EN_SEL, 0xd5),
123 QMP_PHY_INIT_CFG(QSERDES_V3_COM_RESETSM_CNTRL, 0x20),
124 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_SELECT, 0x30),
125 QMP_PHY_INIT_CFG(QSERDES_V3_COM_HSCLK_SEL, 0x00),
126 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_EN, 0x01),
127 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_CTRL, 0x00),
128 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORE_CLK_EN, 0x00),
129 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_MAP, 0x04),
130 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SVS_MODE_CLK_SEL, 0x05),
131 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_INITVAL1, 0xff),
132 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_INITVAL2, 0x00),
133 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE0, 0x82),
134 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CP_CTRL_MODE0, 0x06),
135 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_RCTRL_MODE0, 0x16),
136 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_CCTRL_MODE0, 0x36),
137 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN0_MODE0, 0x3f),
138 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
139 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE1_MODE0, 0xda),
140 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE2_MODE0, 0x01),
141 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE0, 0xff),
142 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE0, 0x0c),
143 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE1, 0x98),
144 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CP_CTRL_MODE1, 0x06),
145 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_RCTRL_MODE1, 0x16),
146 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_CCTRL_MODE1, 0x36),
147 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN0_MODE1, 0x3f),
148 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN1_MODE1, 0x00),
149 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE1_MODE1, 0xc1),
150 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE2_MODE1, 0x00),
151 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE1, 0x32),
152 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE1, 0x0f),
153};
154
155static const struct qmp_ufs_init_tbl sdm845_ufsphy_hs_b_serdes[] = {
156 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_MAP, 0x44),
157};
158
159static const struct qmp_ufs_init_tbl sdm845_ufsphy_tx[] = {
160 QMP_PHY_INIT_CFG(QSERDES_V3_TX_LANE_MODE_1, 0x06),
161 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX, 0x04),
162 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX, 0x07),
163};
164
165static const struct qmp_ufs_init_tbl sdm845_ufsphy_rx[] = {
166 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_LVL, 0x24),
167 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_CNTRL, 0x0f),
168 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_DEGLITCH_CNTRL, 0x1e),
169 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_INTERFACE_MODE, 0x40),
170 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_FO_GAIN, 0x0b),
171 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_TERM_BW, 0x5b),
172 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL2, 0x06),
173 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL3, 0x04),
174 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL4, 0x1b),
175 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SVS_SO_GAIN_HALF, 0x04),
176 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SVS_SO_GAIN_QUARTER, 0x04),
177 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SVS_SO_GAIN, 0x04),
178 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x4b),
179 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_PI_CONTROLS, 0x81),
180 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_COUNT_LOW, 0x80),
181 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_MODE_00, 0x59),
182};
183
184static const struct qmp_ufs_init_tbl sdm845_ufsphy_pcs[] = {
185 QMP_PHY_INIT_CFG(QPHY_V3_PCS_UFS_RX_SIGDET_CTRL2, 0x6e),
186 QMP_PHY_INIT_CFG(QPHY_V3_PCS_UFS_TX_LARGE_AMP_DRV_LVL, 0x0a),
187 QMP_PHY_INIT_CFG(QPHY_V3_PCS_UFS_TX_SMALL_AMP_DRV_LVL, 0x02),
188 QMP_PHY_INIT_CFG(QPHY_V3_PCS_UFS_RX_SYM_RESYNC_CTRL, 0x03),
189 QMP_PHY_INIT_CFG(QPHY_V3_PCS_UFS_TX_MID_TERM_CTRL1, 0x43),
190 QMP_PHY_INIT_CFG(QPHY_V3_PCS_UFS_RX_SIGDET_CTRL1, 0x0f),
191 QMP_PHY_INIT_CFG(QPHY_V3_PCS_UFS_RX_MIN_HIBERN8_TIME, 0x9a),
192 QMP_PHY_INIT_CFG(QPHY_V3_PCS_UFS_MULTI_LANE_CTRL1, 0x02),
193};
194
Julius Lehmann425a9122024-10-02 20:52:17 +0200195static const struct qmp_ufs_init_tbl sm8150_ufsphy_hs_g4_tx[] = {
196 QMP_PHY_INIT_CFG(QSERDES_V4_TX_LANE_MODE_1, 0x75),
197};
198
199static const struct qmp_ufs_init_tbl sm8150_ufsphy_hs_g4_rx[] = {
200 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x5a),
201 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_PI_CTRL2, 0x81),
202 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FO_GAIN, 0x0e),
203 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_TERM_BW, 0x6f),
204 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_MEASURE_TIME, 0x20),
205 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_LOW, 0x80),
206 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_HIGH, 0x01),
207 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_LOW, 0x3f),
208 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH, 0xff),
209 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH2, 0xff),
210 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH3, 0x7f),
211 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH4, 0x6c),
212 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_LOW, 0x6d),
213 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH, 0x6d),
214 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH2, 0xed),
215 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH4, 0x3c),
216};
217
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +0200218static const struct qmp_ufs_init_tbl sm8150_ufsphy_serdes[] = {
219 QMP_PHY_INIT_CFG(QSERDES_V4_COM_SYSCLK_EN_SEL, 0xd9),
220 QMP_PHY_INIT_CFG(QSERDES_V4_COM_HSCLK_SEL, 0x11),
221 QMP_PHY_INIT_CFG(QSERDES_V4_COM_HSCLK_HS_SWITCH_SEL, 0x00),
222 QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP_EN, 0x01),
223 QMP_PHY_INIT_CFG(QSERDES_V4_COM_VCO_TUNE_MAP, 0x02),
224 QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_IVCO, 0x0f),
225 QMP_PHY_INIT_CFG(QSERDES_V4_COM_VCO_TUNE_INITVAL2, 0x00),
226 QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIN_VCOCAL_HSCLK_SEL, 0x11),
227 QMP_PHY_INIT_CFG(QSERDES_V4_COM_DEC_START_MODE0, 0x82),
228 QMP_PHY_INIT_CFG(QSERDES_V4_COM_CP_CTRL_MODE0, 0x06),
229 QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_RCTRL_MODE0, 0x16),
230 QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_CCTRL_MODE0, 0x36),
231 QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP1_MODE0, 0xff),
232 QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP2_MODE0, 0x0c),
233 QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIN_VCOCAL_CMP_CODE1_MODE0, 0xac),
234 QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIN_VCOCAL_CMP_CODE2_MODE0, 0x1e),
235 QMP_PHY_INIT_CFG(QSERDES_V4_COM_DEC_START_MODE1, 0x98),
236 QMP_PHY_INIT_CFG(QSERDES_V4_COM_CP_CTRL_MODE1, 0x06),
237 QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_RCTRL_MODE1, 0x16),
238 QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_CCTRL_MODE1, 0x36),
239 QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP1_MODE1, 0x32),
240 QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP2_MODE1, 0x0f),
241 QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIN_VCOCAL_CMP_CODE1_MODE1, 0xdd),
242 QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIN_VCOCAL_CMP_CODE2_MODE1, 0x23),
243};
244
245static const struct qmp_ufs_init_tbl sm8150_ufsphy_hs_b_serdes[] = {
246 QMP_PHY_INIT_CFG(QSERDES_V4_COM_VCO_TUNE_MAP, 0x06),
247};
248
249static const struct qmp_ufs_init_tbl sm8150_ufsphy_tx[] = {
250 QMP_PHY_INIT_CFG(QSERDES_V4_TX_PWM_GEAR_1_DIVIDER_BAND0_1, 0x06),
251 QMP_PHY_INIT_CFG(QSERDES_V4_TX_PWM_GEAR_2_DIVIDER_BAND0_1, 0x03),
252 QMP_PHY_INIT_CFG(QSERDES_V4_TX_PWM_GEAR_3_DIVIDER_BAND0_1, 0x01),
253 QMP_PHY_INIT_CFG(QSERDES_V4_TX_PWM_GEAR_4_DIVIDER_BAND0_1, 0x00),
254 QMP_PHY_INIT_CFG(QSERDES_V4_TX_LANE_MODE_1, 0x05),
255 QMP_PHY_INIT_CFG(QSERDES_V4_TX_TRAN_DRVR_EMP_EN, 0x0c),
256};
257
258static const struct qmp_ufs_init_tbl sm8150_ufsphy_rx[] = {
259 QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_LVL, 0x24),
260 QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_CNTRL, 0x0f),
261 QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_DEGLITCH_CNTRL, 0x1e),
262 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_BAND, 0x18),
263 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_FO_GAIN, 0x0a),
264 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x4b),
265 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_PI_CONTROLS, 0xf1),
266 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_COUNT_LOW, 0x80),
267 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_PI_CTRL2, 0x80),
268 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FO_GAIN, 0x0c),
269 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_GAIN, 0x04),
270 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_TERM_BW, 0x1b),
271 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL2, 0x06),
272 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL3, 0x04),
273 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL4, 0x1d),
274 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_OFFSET_ADAPTOR_CNTRL2, 0x00),
275 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_MEASURE_TIME, 0x10),
276 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_LOW, 0xc0),
277 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_HIGH, 0x00),
278 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_LOW, 0x36),
279 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH, 0x36),
280 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH2, 0xf6),
281 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH3, 0x3b),
282 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH4, 0x3d),
283 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_LOW, 0xe0),
284 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH, 0xc8),
285 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH2, 0xc8),
286 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH3, 0x3b),
287 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH4, 0xb1),
288 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_LOW, 0xe0),
289 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH, 0xc8),
290 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH2, 0xc8),
291 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH3, 0x3b),
292 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH4, 0xb1),
293};
294
295static const struct qmp_ufs_init_tbl sm8150_ufsphy_pcs[] = {
296 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_RX_SIGDET_CTRL2, 0x6d),
297 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TX_LARGE_AMP_DRV_LVL, 0x0a),
298 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TX_SMALL_AMP_DRV_LVL, 0x02),
299 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TX_MID_TERM_CTRL1, 0x43),
300 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_DEBUG_BUS_CLKSEL, 0x1f),
301 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_RX_MIN_HIBERN8_TIME, 0xff),
302 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_MULTI_LANE_CTRL1, 0x02),
303};
304
305static const struct qmp_ufs_init_tbl sm8150_ufsphy_hs_g4_pcs[] = {
306 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TX_LARGE_AMP_DRV_LVL, 0x10),
307 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_BIST_FIXED_PAT_CTRL, 0x0a),
308};
309
310static const struct qmp_ufs_init_tbl sm8250_ufsphy_hs_g4_tx[] = {
311 QMP_PHY_INIT_CFG(QSERDES_V4_TX_LANE_MODE_1, 0xe5),
312};
313
314static const struct qmp_ufs_init_tbl sm8250_ufsphy_hs_g4_rx[] = {
315 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x5a),
316 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_PI_CTRL2, 0x81),
317 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FO_GAIN, 0x0e),
318 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_TERM_BW, 0x6f),
319 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL1, 0x04),
320 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL2, 0x00),
321 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL3, 0x09),
322 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL4, 0x07),
323 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x17),
324 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_MEASURE_TIME, 0x20),
325 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_LOW, 0x80),
326 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_HIGH, 0x01),
327 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_LOW, 0x3f),
328 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH, 0xff),
329 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH2, 0xff),
330 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH3, 0x7f),
331 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH4, 0x2c),
332 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_LOW, 0x6d),
333 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH, 0x6d),
334 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH2, 0xed),
335 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH4, 0x3c),
336};
337
338static const struct qmp_ufs_init_tbl sm8550_ufsphy_serdes[] = {
339 QMP_PHY_INIT_CFG(QSERDES_V6_COM_SYSCLK_EN_SEL, 0xd9),
340 QMP_PHY_INIT_CFG(QSERDES_V6_COM_CMN_CONFIG_1, 0x16),
341 QMP_PHY_INIT_CFG(QSERDES_V6_COM_HSCLK_SEL_1, 0x11),
342 QMP_PHY_INIT_CFG(QSERDES_V6_COM_HSCLK_HS_SWITCH_SEL_1, 0x00),
343 QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP_EN, 0x01),
344 QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE_MAP, 0x04),
345 QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_IVCO, 0x0f),
346 QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE_INITVAL2, 0x00),
347 QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MODE0, 0x41),
348 QMP_PHY_INIT_CFG(QSERDES_V6_COM_CP_CTRL_MODE0, 0x0a),
349 QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_RCTRL_MODE0, 0x18),
350 QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_CCTRL_MODE0, 0x14),
351 QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP1_MODE0, 0x7f),
352 QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP2_MODE0, 0x06),
353 QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MODE1, 0x4c),
354 QMP_PHY_INIT_CFG(QSERDES_V6_COM_CP_CTRL_MODE1, 0x0a),
355 QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_RCTRL_MODE1, 0x18),
356 QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_CCTRL_MODE1, 0x14),
357 QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP1_MODE1, 0x99),
358 QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP2_MODE1, 0x07),
359};
360
361static const struct qmp_ufs_init_tbl sm8550_ufsphy_hs_b_serdes[] = {
362 QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE_MAP, 0x44),
363};
364
365static const struct qmp_ufs_init_tbl sm8550_ufsphy_tx[] = {
366 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_TX_LANE_MODE_1, 0x05),
367 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_TX_RES_CODE_LANE_OFFSET_TX, 0x07),
368 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_TX_FR_DCC_CTRL, 0x4c),
369};
370
371static const struct qmp_ufs_init_tbl sm8550_ufsphy_rx[] = {
372 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_UCDR_FO_GAIN_RATE2, 0x0c),
373 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_VGA_CAL_MAN_VAL, 0x0e),
374
375 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE_0_1_B0, 0xc2),
376 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE_0_1_B1, 0xc2),
377 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE_0_1_B3, 0x1a),
378 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE_0_1_B6, 0x60),
379
380 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE2_B3, 0x9e),
381 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE2_B6, 0x60),
382
383 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE3_B3, 0x9e),
384 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE3_B4, 0x0e),
385 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE3_B5, 0x36),
386 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE3_B8, 0x02),
387
388};
389
390static const struct qmp_ufs_init_tbl sm8550_ufsphy_pcs[] = {
391 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_RX_SIGDET_CTRL2, 0x69),
392 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_TX_LARGE_AMP_DRV_LVL, 0x0f),
393 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_TX_MID_TERM_CTRL1, 0x43),
394 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_MULTI_LANE_CTRL1, 0x02),
395 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_PLL_CNTL, 0x2b),
396 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_TX_HSGEAR_CAPABILITY, 0x04),
397 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_RX_HSGEAR_CAPABILITY, 0x04),
398 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_PLL_CNTL, 0x33),
399 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_RX_HS_G5_SYNC_LENGTH_CAPABILITY, 0x4f),
400 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_RX_HSG5_SYNC_WAIT_TIME, 0x9e),
401};
402
403static const struct qmp_ufs_init_tbl sm8650_ufsphy_serdes[] = {
404 QMP_PHY_INIT_CFG(QSERDES_V6_COM_SYSCLK_EN_SEL, 0xd9),
405 QMP_PHY_INIT_CFG(QSERDES_V6_COM_CMN_CONFIG_1, 0x16),
406 QMP_PHY_INIT_CFG(QSERDES_V6_COM_HSCLK_SEL_1, 0x11),
407 QMP_PHY_INIT_CFG(QSERDES_V6_COM_HSCLK_HS_SWITCH_SEL_1, 0x00),
408 QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP_EN, 0x01),
409 QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_IVCO, 0x1f),
410 QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_IVCO_MODE1, 0x1f),
411 QMP_PHY_INIT_CFG(QSERDES_V6_COM_CMN_IETRIM, 0x0a),
412 QMP_PHY_INIT_CFG(QSERDES_V6_COM_CMN_IPTRIM, 0x17),
413 QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE_MAP, 0x04),
414 QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE_INITVAL2, 0x00),
415 QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MODE0, 0x41),
416 QMP_PHY_INIT_CFG(QSERDES_V6_COM_CP_CTRL_MODE0, 0x06),
417 QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_RCTRL_MODE0, 0x18),
418 QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_CCTRL_MODE0, 0x14),
419 QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP1_MODE0, 0x7f),
420 QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP2_MODE0, 0x06),
421 QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MODE1, 0x4c),
422 QMP_PHY_INIT_CFG(QSERDES_V6_COM_CP_CTRL_MODE1, 0x06),
423 QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_RCTRL_MODE1, 0x18),
424 QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_CCTRL_MODE1, 0x14),
425 QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP1_MODE1, 0x99),
426 QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP2_MODE1, 0x07),
427};
428
429static const struct qmp_ufs_init_tbl sm8650_ufsphy_tx[] = {
430 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_TX_LANE_MODE_1, 0x01),
431 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_TX_RES_CODE_LANE_OFFSET_TX, 0x07),
432 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_TX_RES_CODE_LANE_OFFSET_RX, 0x0e),
433};
434
435static const struct qmp_ufs_init_tbl sm8650_ufsphy_rx[] = {
436 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_UCDR_FO_GAIN_RATE2, 0x0c),
437 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_UCDR_FO_GAIN_RATE4, 0x0c),
438 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_UCDR_SO_GAIN_RATE4, 0x04),
439 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x14),
440 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_UCDR_PI_CONTROLS, 0x07),
441 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_OFFSET_ADAPTOR_CNTRL3, 0x0e),
442 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_UCDR_FASTLOCK_COUNT_HIGH_RATE4, 0x02),
443 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_UCDR_FASTLOCK_FO_GAIN_RATE4, 0x1c),
444 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_UCDR_FASTLOCK_SO_GAIN_RATE4, 0x06),
445 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_VGA_CAL_MAN_VAL, 0x3e),
446 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_RX_EQU_ADAPTOR_CNTRL4, 0x0f),
447 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE_0_1_B0, 0xce),
448 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE_0_1_B1, 0xce),
449 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE_0_1_B2, 0x18),
450 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE_0_1_B3, 0x1a),
451 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE_0_1_B4, 0x0f),
452 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE_0_1_B6, 0x60),
453 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE2_B3, 0x9e),
454 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE2_B6, 0x60),
455 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE3_B3, 0x9e),
456 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE3_B4, 0x0e),
457 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE3_B5, 0x36),
458 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE3_B8, 0x02),
459 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE4_B0, 0x24),
460 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE4_B1, 0x24),
461 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE4_B2, 0x20),
462 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE4_B3, 0xb9),
463 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_MODE_RATE4_B4, 0x4f),
464 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_UCDR_SO_SATURATION, 0x1f),
465 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_UCDR_PI_CTRL1, 0x94),
466 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_RX_TERM_BW_CTRL0, 0xfa),
467 QMP_PHY_INIT_CFG(QSERDES_UFS_V6_RX_DLL0_FTUNE_CTRL, 0x30),
468};
469
Varadarajan Narayananbcf49ae2025-01-10 10:38:15 +0530470static const struct qmp_ufs_init_tbl sm8350_ufsphy_serdes[] = {
471 QMP_PHY_INIT_CFG(QSERDES_V5_COM_SYSCLK_EN_SEL, 0xd9),
472 QMP_PHY_INIT_CFG(QSERDES_V5_COM_HSCLK_SEL, 0x11),
473 QMP_PHY_INIT_CFG(QSERDES_V5_COM_HSCLK_HS_SWITCH_SEL, 0x00),
474 QMP_PHY_INIT_CFG(QSERDES_V5_COM_LOCK_CMP_EN, 0x42),
475 QMP_PHY_INIT_CFG(QSERDES_V5_COM_VCO_TUNE_MAP, 0x02),
476 QMP_PHY_INIT_CFG(QSERDES_V5_COM_PLL_IVCO, 0x0f),
477 QMP_PHY_INIT_CFG(QSERDES_V5_COM_VCO_TUNE_INITVAL2, 0x00),
478 QMP_PHY_INIT_CFG(QSERDES_V5_COM_BIN_VCOCAL_HSCLK_SEL, 0x11),
479 QMP_PHY_INIT_CFG(QSERDES_V5_COM_DEC_START_MODE0, 0x82),
480 QMP_PHY_INIT_CFG(QSERDES_V5_COM_CP_CTRL_MODE0, 0x14),
481 QMP_PHY_INIT_CFG(QSERDES_V5_COM_PLL_RCTRL_MODE0, 0x18),
482 QMP_PHY_INIT_CFG(QSERDES_V5_COM_PLL_CCTRL_MODE0, 0x18),
483 QMP_PHY_INIT_CFG(QSERDES_V5_COM_LOCK_CMP1_MODE0, 0xff),
484 QMP_PHY_INIT_CFG(QSERDES_V5_COM_LOCK_CMP2_MODE0, 0x19),
485 QMP_PHY_INIT_CFG(QSERDES_V5_COM_BIN_VCOCAL_CMP_CODE1_MODE0, 0xac),
486 QMP_PHY_INIT_CFG(QSERDES_V5_COM_BIN_VCOCAL_CMP_CODE2_MODE0, 0x1e),
487 QMP_PHY_INIT_CFG(QSERDES_V5_COM_DEC_START_MODE1, 0x98),
488 QMP_PHY_INIT_CFG(QSERDES_V5_COM_CP_CTRL_MODE1, 0x14),
489 QMP_PHY_INIT_CFG(QSERDES_V5_COM_PLL_RCTRL_MODE1, 0x18),
490 QMP_PHY_INIT_CFG(QSERDES_V5_COM_PLL_CCTRL_MODE1, 0x18),
491 QMP_PHY_INIT_CFG(QSERDES_V5_COM_LOCK_CMP1_MODE1, 0x65),
492 QMP_PHY_INIT_CFG(QSERDES_V5_COM_LOCK_CMP2_MODE1, 0x1e),
493 QMP_PHY_INIT_CFG(QSERDES_V5_COM_BIN_VCOCAL_CMP_CODE1_MODE1, 0xdd),
494 QMP_PHY_INIT_CFG(QSERDES_V5_COM_BIN_VCOCAL_CMP_CODE2_MODE1, 0x23),
495};
496
497static const struct qmp_ufs_init_tbl sm8350_ufsphy_hs_b_serdes[] = {
498 QMP_PHY_INIT_CFG(QSERDES_V5_COM_VCO_TUNE_MAP, 0x06),
499};
500
501static const struct qmp_ufs_init_tbl sm8350_ufsphy_tx[] = {
502 QMP_PHY_INIT_CFG(QSERDES_V5_TX_PWM_GEAR_1_DIVIDER_BAND0_1, 0x06),
503 QMP_PHY_INIT_CFG(QSERDES_V5_TX_PWM_GEAR_2_DIVIDER_BAND0_1, 0x03),
504 QMP_PHY_INIT_CFG(QSERDES_V5_TX_PWM_GEAR_3_DIVIDER_BAND0_1, 0x01),
505 QMP_PHY_INIT_CFG(QSERDES_V5_TX_PWM_GEAR_4_DIVIDER_BAND0_1, 0x00),
506 QMP_PHY_INIT_CFG(QSERDES_V5_TX_LANE_MODE_1, 0xf5),
507 QMP_PHY_INIT_CFG(QSERDES_V5_TX_LANE_MODE_3, 0x3f),
508 QMP_PHY_INIT_CFG(QSERDES_V5_TX_RES_CODE_LANE_OFFSET_TX, 0x09),
509 QMP_PHY_INIT_CFG(QSERDES_V5_TX_RES_CODE_LANE_OFFSET_RX, 0x09),
510 QMP_PHY_INIT_CFG(QSERDES_V5_TX_TRAN_DRVR_EMP_EN, 0x0c),
511};
512
513static const struct qmp_ufs_init_tbl sm8350_ufsphy_rx[] = {
514 QMP_PHY_INIT_CFG(QSERDES_V5_RX_SIGDET_LVL, 0x24),
515 QMP_PHY_INIT_CFG(QSERDES_V5_RX_SIGDET_CNTRL, 0x0f),
516 QMP_PHY_INIT_CFG(QSERDES_V5_RX_SIGDET_DEGLITCH_CNTRL, 0x1e),
517 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_BAND, 0x18),
518 QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_FASTLOCK_FO_GAIN, 0x0a),
519 QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x5a),
520 QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_PI_CONTROLS, 0xf1),
521 QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_FASTLOCK_COUNT_LOW, 0x80),
522 QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_PI_CTRL2, 0x80),
523 QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_FO_GAIN, 0x0e),
524 QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_SO_GAIN, 0x04),
525 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_TERM_BW, 0x1b),
526 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQU_ADAPTOR_CNTRL1, 0x04),
527 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQU_ADAPTOR_CNTRL2, 0x06),
528 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQU_ADAPTOR_CNTRL3, 0x04),
529 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQU_ADAPTOR_CNTRL4, 0x1a),
530 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x17),
531 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_OFFSET_ADAPTOR_CNTRL2, 0x00),
532 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_IDAC_MEASURE_TIME, 0x10),
533 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_IDAC_TSETTLE_LOW, 0xc0),
534 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_IDAC_TSETTLE_HIGH, 0x00),
535 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_LOW, 0x6d),
536 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_HIGH, 0x6d),
537 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_HIGH2, 0xed),
538 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_HIGH3, 0x3b),
539 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_HIGH4, 0x3c),
540 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_LOW, 0xe0),
541 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_HIGH, 0xc8),
542 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_HIGH2, 0xc8),
543 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_HIGH3, 0x3b),
544 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_HIGH4, 0xb7),
545 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_10_LOW, 0xe0),
546 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_10_HIGH, 0xc8),
547 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_10_HIGH2, 0xc8),
548 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_10_HIGH3, 0x3b),
549 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_10_HIGH4, 0xb7),
550 QMP_PHY_INIT_CFG(QSERDES_V5_RX_DCC_CTRL1, 0x0c),
551};
552
553static const struct qmp_ufs_init_tbl sm8350_ufsphy_pcs[] = {
554 QMP_PHY_INIT_CFG(QPHY_V5_PCS_UFS_RX_SIGDET_CTRL2, 0x6d),
555 QMP_PHY_INIT_CFG(QPHY_V5_PCS_UFS_TX_LARGE_AMP_DRV_LVL, 0x0a),
556 QMP_PHY_INIT_CFG(QPHY_V5_PCS_UFS_TX_SMALL_AMP_DRV_LVL, 0x02),
557 QMP_PHY_INIT_CFG(QPHY_V5_PCS_UFS_TX_MID_TERM_CTRL1, 0x43),
558 QMP_PHY_INIT_CFG(QPHY_V5_PCS_UFS_DEBUG_BUS_CLKSEL, 0x1f),
559 QMP_PHY_INIT_CFG(QPHY_V5_PCS_UFS_RX_MIN_HIBERN8_TIME, 0xff),
560 QMP_PHY_INIT_CFG(QPHY_V5_PCS_UFS_RX_SIGDET_CTRL1, 0x0e),
561 QMP_PHY_INIT_CFG(QPHY_V5_PCS_UFS_MULTI_LANE_CTRL1, 0x02),
562};
563
564static const struct qmp_ufs_init_tbl sm8350_ufsphy_g4_tx[] = {
565 QMP_PHY_INIT_CFG(QSERDES_V5_TX_LANE_MODE_1, 0xe5),
566};
567
568static const struct qmp_ufs_init_tbl sm8350_ufsphy_g4_rx[] = {
569 QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_PI_CTRL2, 0x81),
570 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_TERM_BW, 0x6f),
571 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQU_ADAPTOR_CNTRL2, 0x00),
572 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQU_ADAPTOR_CNTRL3, 0x4a),
573 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQU_ADAPTOR_CNTRL4, 0x0a),
574 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_IDAC_MEASURE_TIME, 0x20),
575 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_IDAC_TSETTLE_LOW, 0x80),
576 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_IDAC_TSETTLE_HIGH, 0x01),
577 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_LOW, 0xbf),
578 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_HIGH, 0xbf),
579 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_HIGH2, 0x7f),
580 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_HIGH3, 0x7f),
581 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_HIGH4, 0x2d),
582 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_LOW, 0x6d),
583 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_HIGH, 0x6d),
584 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_HIGH2, 0xed),
585 QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_HIGH4, 0x3c),
586};
587
588static const struct qmp_ufs_init_tbl sm8350_ufsphy_g4_pcs[] = {
589 QMP_PHY_INIT_CFG(QPHY_V5_PCS_UFS_BIST_FIXED_PAT_CTRL, 0x0a),
590};
591
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +0200592static const struct qmp_ufs_init_tbl sm8650_ufsphy_pcs[] = {
593 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_MULTI_LANE_CTRL1, 0x02),
594 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_TX_MID_TERM_CTRL1, 0x43),
595 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_PCS_CTRL1, 0xc1),
596 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_TX_LARGE_AMP_DRV_LVL, 0x0f),
597 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_RX_SIGDET_CTRL2, 0x68),
598 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_TX_POST_EMP_LVL_S4, 0x0e),
599 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_TX_POST_EMP_LVL_S5, 0x12),
600 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_TX_POST_EMP_LVL_S6, 0x15),
601 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_TX_POST_EMP_LVL_S7, 0x19),
602 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_PLL_CNTL, 0x13),
603 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_TX_HSGEAR_CAPABILITY, 0x04),
604 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_RX_HSGEAR_CAPABILITY, 0x04),
605 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_PLL_CNTL, 0x33),
606 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_TX_HSGEAR_CAPABILITY, 0x05),
607 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_RX_HSGEAR_CAPABILITY, 0x05),
608 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_RX_HS_G5_SYNC_LENGTH_CAPABILITY, 0x4d),
609 QMP_PHY_INIT_CFG(QPHY_V6_PCS_UFS_RX_HSG5_SYNC_WAIT_TIME, 0x9e),
610};
611
Caleb Connollyf2021a22024-10-12 15:22:05 +0200612
613static const struct qmp_ufs_init_tbl sc7280_ufsphy_tx[] = {
614 QMP_PHY_INIT_CFG(QSERDES_V4_TX_PWM_GEAR_1_DIVIDER_BAND0_1, 0x06),
615 QMP_PHY_INIT_CFG(QSERDES_V4_TX_PWM_GEAR_2_DIVIDER_BAND0_1, 0x03),
616 QMP_PHY_INIT_CFG(QSERDES_V4_TX_PWM_GEAR_3_DIVIDER_BAND0_1, 0x01),
617 QMP_PHY_INIT_CFG(QSERDES_V4_TX_PWM_GEAR_4_DIVIDER_BAND0_1, 0x00),
618 QMP_PHY_INIT_CFG(QSERDES_V4_TX_LANE_MODE_1, 0x35),
619 QMP_PHY_INIT_CFG(QSERDES_V4_TX_TRAN_DRVR_EMP_EN, 0x0c),
620};
621
622static const struct qmp_ufs_init_tbl sc7280_ufsphy_rx[] = {
623 QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_LVL, 0x24),
624 QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_CNTRL, 0x0f),
625 QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_DEGLITCH_CNTRL, 0x1e),
626 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_BAND, 0x18),
627 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_FO_GAIN, 0x0a),
628 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x5a),
629 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_PI_CONTROLS, 0xf1),
630 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_COUNT_LOW, 0x80),
631 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_PI_CTRL2, 0x80),
632 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FO_GAIN, 0x0e),
633 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_GAIN, 0x04),
634 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_TERM_BW, 0x1b),
635 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL2, 0x06),
636 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL3, 0x04),
637 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL4, 0x1d),
638 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_OFFSET_ADAPTOR_CNTRL2, 0x00),
639 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_MEASURE_TIME, 0x10),
640 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_LOW, 0xc0),
641 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_HIGH, 0x00),
642 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_LOW, 0x6d),
643 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH, 0x6d),
644 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH2, 0xed),
645 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH3, 0x3b),
646 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH4, 0x3c),
647 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_LOW, 0xe0),
648 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH, 0xc8),
649 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH2, 0xc8),
650 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH3, 0x3b),
651 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH4, 0xb1),
652 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_LOW, 0xe0),
653 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH, 0xc8),
654 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH2, 0xc8),
655 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH3, 0x3b),
656 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH4, 0xb1),
657 QMP_PHY_INIT_CFG(QSERDES_V4_RX_DCC_CTRL1, 0x0c),
658};
659
660static const struct qmp_ufs_init_tbl sc7280_ufsphy_pcs[] = {
661 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_RX_SIGDET_CTRL2, 0x6d),
662 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TX_LARGE_AMP_DRV_LVL, 0x0a),
663 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TX_SMALL_AMP_DRV_LVL, 0x02),
664 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TX_MID_TERM_CTRL1, 0x43),
665 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_DEBUG_BUS_CLKSEL, 0x1f),
666 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_RX_MIN_HIBERN8_TIME, 0xff),
667 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_MULTI_LANE_CTRL1, 0x02),
668 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_PLL_CNTL, 0x03),
669 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TIMER_20US_CORECLK_STEPS_MSB, 0x16),
670 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TIMER_20US_CORECLK_STEPS_LSB, 0xd8),
671 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TX_PWM_GEAR_BAND, 0xaa),
672 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TX_HS_GEAR_BAND, 0x06),
673 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_TX_HSGEAR_CAPABILITY, 0x03),
674 QMP_PHY_INIT_CFG(QPHY_V4_PCS_UFS_RX_HSGEAR_CAPABILITY, 0x03),
675};
676
677static const struct qmp_ufs_init_tbl sc7280_ufsphy_hs_g4_rx[] = {
678 QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_LVL, 0x24),
679 QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_CNTRL, 0x0f),
680 QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_DEGLITCH_CNTRL, 0x1e),
681 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_BAND, 0x18),
682 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_FO_GAIN, 0x0a),
683 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x5a),
684 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_PI_CONTROLS, 0xf1),
685 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_COUNT_LOW, 0x80),
686 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_PI_CTRL2, 0x81),
687 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FO_GAIN, 0x0e),
688 QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_GAIN, 0x04),
689 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_TERM_BW, 0x6f),
690 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL1, 0x04),
691 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL2, 0x00),
692 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL3, 0x09),
693 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL4, 0x07),
694 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x17),
695 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_OFFSET_ADAPTOR_CNTRL2, 0x00),
696 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_MEASURE_TIME, 0x20),
697 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_LOW, 0x80),
698 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_HIGH, 0x01),
699 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_LOW, 0x3f),
700 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH, 0xff),
701 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH2, 0xff),
702 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH3, 0x7f),
703 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH4, 0x2c),
704 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_LOW, 0x6d),
705 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH, 0x6d),
706 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH2, 0xed),
707 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH3, 0x3b),
708 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH4, 0x3c),
709 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_LOW, 0xe0),
710 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH, 0xc8),
711 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH2, 0xc8),
712 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH3, 0x3b),
713 QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_10_HIGH4, 0xb1),
714 QMP_PHY_INIT_CFG(QSERDES_V4_RX_DCC_CTRL1, 0x0c),
715 QMP_PHY_INIT_CFG(QSERDES_V4_RX_GM_CAL, 0x0f),
716};
717
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +0200718struct qmp_ufs_offsets {
719 u16 serdes;
720 u16 pcs;
721 u16 tx;
722 u16 rx;
723 /* for PHYs with >= 2 lanes */
724 u16 tx2;
725 u16 rx2;
726};
727
728struct qmp_ufs_cfg_tbls {
729 /* Init sequence for PHY blocks - serdes, tx, rx, pcs */
730 const struct qmp_ufs_init_tbl *serdes;
731 int serdes_num;
732 const struct qmp_ufs_init_tbl *tx;
733 int tx_num;
734 const struct qmp_ufs_init_tbl *rx;
735 int rx_num;
736 const struct qmp_ufs_init_tbl *pcs;
737 int pcs_num;
738};
739
740/* struct qmp_ufs_cfg - per-PHY initialization config */
741struct qmp_ufs_cfg {
742 int lanes;
743
744 const struct qmp_ufs_offsets *offsets;
745
746 /* Main init sequence for PHY blocks - serdes, tx, rx, pcs */
747 const struct qmp_ufs_cfg_tbls tbls;
748 /* Additional sequence for HS Series B */
749 const struct qmp_ufs_cfg_tbls tbls_hs_b;
750 /* Additional sequence for HS G4 */
751 const struct qmp_ufs_cfg_tbls tbls_hs_g4;
752
753 /* clock ids to be requested */
754 const char * const *clk_list;
755 int num_clks;
756 /* regulators to be requested */
757 const char * const *vreg_list;
758 int num_vregs;
759 /* resets to be requested */
760 const char * const *reset_list;
761 int num_resets;
762
763 /* array of registers with different offsets */
764 const unsigned int *regs;
765
766 /* true, if PCS block has no separate SW_RESET register */
767 bool no_pcs_sw_reset;
768};
769
770struct qmp_ufs_priv {
771 struct phy *phy;
772
773 void __iomem *serdes;
774 void __iomem *pcs;
775 void __iomem *pcs_misc;
776 void __iomem *tx;
777 void __iomem *rx;
778 void __iomem *tx2;
779 void __iomem *rx2;
780
781 struct clk *clks;
782 unsigned int clk_count;
783
784 struct reset_ctl *resets;
785 unsigned int reset_count;
786
787 const struct qmp_ufs_cfg *cfg;
788
789 struct udevice *dev;
790
791 u32 mode;
792 u32 submode;
793};
794
795static inline void qphy_setbits(void __iomem *base, u32 offset, u32 val)
796{
797 u32 reg;
798
799 reg = readl(base + offset);
800 reg |= val;
801 writel(reg, base + offset);
802
803 /* ensure that above write is through */
804 readl(base + offset);
805}
806
807static inline void qphy_clrbits(void __iomem *base, u32 offset, u32 val)
808{
809 u32 reg;
810
811 reg = readl(base + offset);
812 reg &= ~val;
813 writel(reg, base + offset);
814
815 /* ensure that above write is through */
816 readl(base + offset);
817}
818
819/* list of clocks required by phy */
820static const char * const sdm845_ufs_phy_clk_l[] = {
821 "ref", "ref_aux",
822};
823
Varadarajan Narayananbcf49ae2025-01-10 10:38:15 +0530824/* the primary usb3 phy on sm8250 doesn't have a ref clock */
825static const char * const sm8450_ufs_phy_clk_l[] = {
826 "qref", "ref", "ref_aux",
827};
828
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +0200829/* list of regulators */
830static const char * const qmp_ufs_vreg_l[] = {
831 "vdda-phy", "vdda-pll",
832};
833
834/* list of resets */
835static const char * const qmp_ufs_reset_l[] = {
836 "ufsphy",
837};
838
839static const struct qmp_ufs_offsets qmp_ufs_offsets = {
840 .serdes = 0,
841 .pcs = 0xc00,
842 .tx = 0x400,
843 .rx = 0x600,
844 .tx2 = 0x800,
845 .rx2 = 0xa00,
846};
847
848static const struct qmp_ufs_offsets qmp_ufs_offsets_v6 = {
849 .serdes = 0,
850 .pcs = 0x0400,
851 .tx = 0x1000,
852 .rx = 0x1200,
853 .tx2 = 0x1800,
854 .rx2 = 0x1a00,
855};
856
857static const struct qmp_ufs_cfg sdm845_ufsphy_cfg = {
858 .lanes = 2,
859
860 .offsets = &qmp_ufs_offsets,
861
862 .tbls = {
863 .serdes = sdm845_ufsphy_serdes,
864 .serdes_num = ARRAY_SIZE(sdm845_ufsphy_serdes),
865 .tx = sdm845_ufsphy_tx,
866 .tx_num = ARRAY_SIZE(sdm845_ufsphy_tx),
867 .rx = sdm845_ufsphy_rx,
868 .rx_num = ARRAY_SIZE(sdm845_ufsphy_rx),
869 .pcs = sdm845_ufsphy_pcs,
870 .pcs_num = ARRAY_SIZE(sdm845_ufsphy_pcs),
871 },
872 .tbls_hs_b = {
873 .serdes = sdm845_ufsphy_hs_b_serdes,
874 .serdes_num = ARRAY_SIZE(sdm845_ufsphy_hs_b_serdes),
875 },
876 .clk_list = sdm845_ufs_phy_clk_l,
877 .num_clks = ARRAY_SIZE(sdm845_ufs_phy_clk_l),
878 .vreg_list = qmp_ufs_vreg_l,
879 .num_vregs = ARRAY_SIZE(qmp_ufs_vreg_l),
880 .regs = ufsphy_v3_regs_layout,
881
882 .no_pcs_sw_reset = true,
883};
884
Julius Lehmann425a9122024-10-02 20:52:17 +0200885static const struct qmp_ufs_cfg sm8150_ufsphy_cfg = {
886 .lanes = 2,
887
888 .offsets = &qmp_ufs_offsets,
889
890 .tbls = {
891 .serdes = sm8150_ufsphy_serdes,
892 .serdes_num = ARRAY_SIZE(sm8150_ufsphy_serdes),
893 .tx = sm8150_ufsphy_tx,
894 .tx_num = ARRAY_SIZE(sm8150_ufsphy_tx),
895 .rx = sm8150_ufsphy_rx,
896 .rx_num = ARRAY_SIZE(sm8150_ufsphy_rx),
897 .pcs = sm8150_ufsphy_pcs,
898 .pcs_num = ARRAY_SIZE(sm8150_ufsphy_pcs),
899 },
900 .tbls_hs_b = {
901 .serdes = sm8150_ufsphy_hs_b_serdes,
902 .serdes_num = ARRAY_SIZE(sm8150_ufsphy_hs_b_serdes),
903 },
904 .tbls_hs_g4 = {
905 .tx = sm8150_ufsphy_hs_g4_tx,
906 .tx_num = ARRAY_SIZE(sm8150_ufsphy_hs_g4_tx),
907 .rx = sm8150_ufsphy_hs_g4_rx,
908 .rx_num = ARRAY_SIZE(sm8150_ufsphy_hs_g4_rx),
909 .pcs = sm8150_ufsphy_hs_g4_pcs,
910 .pcs_num = ARRAY_SIZE(sm8150_ufsphy_hs_g4_pcs),
911 },
912 .clk_list = sdm845_ufs_phy_clk_l,
913 .num_clks = ARRAY_SIZE(sdm845_ufs_phy_clk_l),
914 .vreg_list = qmp_ufs_vreg_l,
915 .num_vregs = ARRAY_SIZE(qmp_ufs_vreg_l),
916 .reset_list = qmp_ufs_reset_l,
917 .num_resets = ARRAY_SIZE(qmp_ufs_reset_l),
918 .regs = ufsphy_v4_regs_layout,
919
920 .no_pcs_sw_reset = false,
921};
922
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +0200923static const struct qmp_ufs_cfg sm8250_ufsphy_cfg = {
924 .lanes = 2,
925
926 .offsets = &qmp_ufs_offsets,
927
928 .tbls = {
929 .serdes = sm8150_ufsphy_serdes,
930 .serdes_num = ARRAY_SIZE(sm8150_ufsphy_serdes),
931 .tx = sm8150_ufsphy_tx,
932 .tx_num = ARRAY_SIZE(sm8150_ufsphy_tx),
933 .rx = sm8150_ufsphy_rx,
934 .rx_num = ARRAY_SIZE(sm8150_ufsphy_rx),
935 .pcs = sm8150_ufsphy_pcs,
936 .pcs_num = ARRAY_SIZE(sm8150_ufsphy_pcs),
937 },
938 .tbls_hs_b = {
939 .serdes = sm8150_ufsphy_hs_b_serdes,
940 .serdes_num = ARRAY_SIZE(sm8150_ufsphy_hs_b_serdes),
941 },
942 .tbls_hs_g4 = {
943 .tx = sm8250_ufsphy_hs_g4_tx,
944 .tx_num = ARRAY_SIZE(sm8250_ufsphy_hs_g4_tx),
945 .rx = sm8250_ufsphy_hs_g4_rx,
946 .rx_num = ARRAY_SIZE(sm8250_ufsphy_hs_g4_rx),
947 .pcs = sm8150_ufsphy_hs_g4_pcs,
948 .pcs_num = ARRAY_SIZE(sm8150_ufsphy_hs_g4_pcs),
949 },
950 .clk_list = sdm845_ufs_phy_clk_l,
951 .num_clks = ARRAY_SIZE(sdm845_ufs_phy_clk_l),
952 .vreg_list = qmp_ufs_vreg_l,
953 .num_vregs = ARRAY_SIZE(qmp_ufs_vreg_l),
954 .reset_list = qmp_ufs_reset_l,
955 .num_resets = ARRAY_SIZE(qmp_ufs_reset_l),
956 .regs = ufsphy_v4_regs_layout,
957
958 .no_pcs_sw_reset = false,
959};
960
961static const struct qmp_ufs_cfg sm8550_ufsphy_cfg = {
962 .lanes = 2,
963
964 .offsets = &qmp_ufs_offsets_v6,
965
966 .tbls = {
967 .serdes = sm8550_ufsphy_serdes,
968 .serdes_num = ARRAY_SIZE(sm8550_ufsphy_serdes),
969 .tx = sm8550_ufsphy_tx,
970 .tx_num = ARRAY_SIZE(sm8550_ufsphy_tx),
971 .rx = sm8550_ufsphy_rx,
972 .rx_num = ARRAY_SIZE(sm8550_ufsphy_rx),
973 .pcs = sm8550_ufsphy_pcs,
974 .pcs_num = ARRAY_SIZE(sm8550_ufsphy_pcs),
975 },
976 .tbls_hs_b = {
977 .serdes = sm8550_ufsphy_hs_b_serdes,
978 .serdes_num = ARRAY_SIZE(sm8550_ufsphy_hs_b_serdes),
979 },
980 .clk_list = sdm845_ufs_phy_clk_l,
981 .num_clks = ARRAY_SIZE(sdm845_ufs_phy_clk_l),
982 .vreg_list = qmp_ufs_vreg_l,
983 .num_vregs = ARRAY_SIZE(qmp_ufs_vreg_l),
984 .regs = ufsphy_v6_regs_layout,
985
986 .no_pcs_sw_reset = false,
987};
988
989static const struct qmp_ufs_cfg sm8650_ufsphy_cfg = {
990 .lanes = 2,
991
992 .offsets = &qmp_ufs_offsets_v6,
993
994 .tbls = {
995 .serdes = sm8650_ufsphy_serdes,
996 .serdes_num = ARRAY_SIZE(sm8650_ufsphy_serdes),
997 .tx = sm8650_ufsphy_tx,
998 .tx_num = ARRAY_SIZE(sm8650_ufsphy_tx),
999 .rx = sm8650_ufsphy_rx,
1000 .rx_num = ARRAY_SIZE(sm8650_ufsphy_rx),
1001 .pcs = sm8650_ufsphy_pcs,
1002 .pcs_num = ARRAY_SIZE(sm8650_ufsphy_pcs),
1003 },
1004 .clk_list = sdm845_ufs_phy_clk_l,
1005 .num_clks = ARRAY_SIZE(sdm845_ufs_phy_clk_l),
1006 .vreg_list = qmp_ufs_vreg_l,
1007 .num_vregs = ARRAY_SIZE(qmp_ufs_vreg_l),
1008 .regs = ufsphy_v6_regs_layout,
1009
1010 .no_pcs_sw_reset = false,
1011};
1012
Caleb Connollyf2021a22024-10-12 15:22:05 +02001013
1014static const struct qmp_ufs_cfg sc7280_ufsphy_cfg = {
1015 .lanes = 2,
1016
1017 .offsets = &qmp_ufs_offsets,
1018
1019 .tbls = {
1020 .serdes = sm8150_ufsphy_serdes,
1021 .serdes_num = ARRAY_SIZE(sm8150_ufsphy_serdes),
1022 .tx = sc7280_ufsphy_tx,
1023 .tx_num = ARRAY_SIZE(sc7280_ufsphy_tx),
1024 .rx = sc7280_ufsphy_rx,
1025 .rx_num = ARRAY_SIZE(sc7280_ufsphy_rx),
1026 .pcs = sc7280_ufsphy_pcs,
1027 .pcs_num = ARRAY_SIZE(sc7280_ufsphy_pcs),
1028 },
1029 .tbls_hs_b = {
1030 .serdes = sm8150_ufsphy_hs_b_serdes,
1031 .serdes_num = ARRAY_SIZE(sm8150_ufsphy_hs_b_serdes),
1032 },
1033 .tbls_hs_g4 = {
1034 .tx = sm8250_ufsphy_hs_g4_tx,
1035 .tx_num = ARRAY_SIZE(sm8250_ufsphy_hs_g4_tx),
1036 .rx = sc7280_ufsphy_hs_g4_rx,
1037 .rx_num = ARRAY_SIZE(sc7280_ufsphy_hs_g4_rx),
1038 .pcs = sm8150_ufsphy_hs_g4_pcs,
1039 .pcs_num = ARRAY_SIZE(sm8150_ufsphy_hs_g4_pcs),
1040 },
1041 .clk_list = sdm845_ufs_phy_clk_l,
1042 .num_clks = ARRAY_SIZE(sdm845_ufs_phy_clk_l),
1043 .vreg_list = qmp_ufs_vreg_l,
1044 .num_vregs = ARRAY_SIZE(qmp_ufs_vreg_l),
1045 .regs = ufsphy_v4_regs_layout,
1046};
1047
Varadarajan Narayananbcf49ae2025-01-10 10:38:15 +05301048static const struct qmp_ufs_cfg sa8775p_ufsphy_cfg = {
1049 .lanes = 2,
1050
1051 .offsets = &qmp_ufs_offsets,
1052
1053 .tbls = {
1054 .serdes = sm8350_ufsphy_serdes,
1055 .serdes_num = ARRAY_SIZE(sm8350_ufsphy_serdes),
1056 .tx = sm8350_ufsphy_tx,
1057 .tx_num = ARRAY_SIZE(sm8350_ufsphy_tx),
1058 .rx = sm8350_ufsphy_rx,
1059 .rx_num = ARRAY_SIZE(sm8350_ufsphy_rx),
1060 .pcs = sm8350_ufsphy_pcs,
1061 .pcs_num = ARRAY_SIZE(sm8350_ufsphy_pcs),
1062 },
1063 .tbls_hs_b = {
1064 .serdes = sm8350_ufsphy_hs_b_serdes,
1065 .serdes_num = ARRAY_SIZE(sm8350_ufsphy_hs_b_serdes),
1066 },
1067 .tbls_hs_g4 = {
1068 .tx = sm8350_ufsphy_g4_tx,
1069 .tx_num = ARRAY_SIZE(sm8350_ufsphy_g4_tx),
1070 .rx = sm8350_ufsphy_g4_rx,
1071 .rx_num = ARRAY_SIZE(sm8350_ufsphy_g4_rx),
1072 .pcs = sm8350_ufsphy_g4_pcs,
1073 .pcs_num = ARRAY_SIZE(sm8350_ufsphy_g4_pcs),
1074 },
1075 .clk_list = sm8450_ufs_phy_clk_l,
1076 .num_clks = ARRAY_SIZE(sm8450_ufs_phy_clk_l),
1077 .vreg_list = qmp_ufs_vreg_l,
1078 .num_vregs = ARRAY_SIZE(qmp_ufs_vreg_l),
1079 .regs = ufsphy_v5_regs_layout,
1080};
1081
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +02001082static void qmp_ufs_configure_lane(void __iomem *base,
1083 const struct qmp_ufs_init_tbl tbl[],
1084 int num,
1085 u8 lane_mask)
1086{
1087 int i;
1088 const struct qmp_ufs_init_tbl *t = tbl;
1089
1090 if (!t)
1091 return;
1092
1093 for (i = 0; i < num; i++, t++) {
1094 if (!(t->lane_mask & lane_mask))
1095 continue;
1096
1097 writel(t->val, base + t->offset);
1098 }
1099}
1100
1101static void qmp_ufs_configure(void __iomem *base,
1102 const struct qmp_ufs_init_tbl tbl[],
1103 int num)
1104{
1105 qmp_ufs_configure_lane(base, tbl, num, 0xff);
1106}
1107
1108static void qmp_ufs_serdes_init(struct qmp_ufs_priv *qmp, const struct qmp_ufs_cfg_tbls *tbls)
1109{
1110 void __iomem *serdes = qmp->serdes;
1111
1112 qmp_ufs_configure(serdes, tbls->serdes, tbls->serdes_num);
1113}
1114
1115static void qmp_ufs_lanes_init(struct qmp_ufs_priv *qmp, const struct qmp_ufs_cfg_tbls *tbls)
1116{
1117 const struct qmp_ufs_cfg *cfg = qmp->cfg;
1118 void __iomem *tx = qmp->tx;
1119 void __iomem *rx = qmp->rx;
1120
1121 qmp_ufs_configure_lane(tx, tbls->tx, tbls->tx_num, 1);
1122 qmp_ufs_configure_lane(rx, tbls->rx, tbls->rx_num, 1);
1123
1124 if (cfg->lanes >= 2) {
1125 qmp_ufs_configure_lane(qmp->tx2, tbls->tx, tbls->tx_num, 2);
1126 qmp_ufs_configure_lane(qmp->rx2, tbls->rx, tbls->rx_num, 2);
1127 }
1128}
1129
1130static void qmp_ufs_pcs_init(struct qmp_ufs_priv *qmp, const struct qmp_ufs_cfg_tbls *tbls)
1131{
1132 void __iomem *pcs = qmp->pcs;
1133
1134 qmp_ufs_configure(pcs, tbls->pcs, tbls->pcs_num);
1135}
1136
1137static void qmp_ufs_init_registers(struct qmp_ufs_priv *qmp, const struct qmp_ufs_cfg *cfg)
1138{
1139 /* We support 'PHY_MODE_UFS_HS_B' mode & 'UFS_HS_G3' submode for now. */
1140 qmp_ufs_serdes_init(qmp, &cfg->tbls);
1141 qmp_ufs_serdes_init(qmp, &cfg->tbls_hs_b);
1142 qmp_ufs_serdes_init(qmp, &cfg->tbls_hs_g4);
1143 qmp_ufs_lanes_init(qmp, &cfg->tbls);
1144 qmp_ufs_pcs_init(qmp, &cfg->tbls);
1145}
1146
1147static int qmp_ufs_do_reset(struct qmp_ufs_priv *qmp)
1148{
1149 int i, ret;
1150
1151 for (i = 0; i < qmp->reset_count; i++) {
1152 ret = reset_assert(&qmp->resets[i]);
1153 if (ret)
1154 return ret;
1155 }
1156
1157 udelay(10);
1158
1159 for (i = 0; i < qmp->reset_count; i++) {
1160 ret = reset_deassert(&qmp->resets[i]);
1161 if (ret)
1162 return ret;
1163 }
1164
1165 udelay(50);
1166
1167 return 0;
1168}
1169
1170static int qmp_ufs_power_on(struct phy *phy)
1171{
1172 struct qmp_ufs_priv *qmp = dev_get_priv(phy->dev);
1173 const struct qmp_ufs_cfg *cfg = qmp->cfg;
1174 void __iomem *pcs = qmp->pcs;
1175 void __iomem *status;
1176 unsigned int val;
1177 int ret;
1178
1179 /* Power down PHY */
1180 qphy_setbits(pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL], SW_PWRDN);
1181
1182 qmp_ufs_init_registers(qmp, cfg);
1183
1184 if (cfg->no_pcs_sw_reset) {
1185 ret = qmp_ufs_do_reset(qmp);
1186 if (ret) {
1187 dev_err(phy->dev, "qmp reset failed\n");
1188 return ret;
1189 }
1190 }
1191
1192 /* Pull PHY out of reset state */
1193 if (!cfg->no_pcs_sw_reset)
1194 qphy_clrbits(pcs, cfg->regs[QPHY_SW_RESET], SW_RESET);
1195
1196 /* start SerDes */
1197 qphy_setbits(pcs, cfg->regs[QPHY_START_CTRL], SERDES_START);
1198
1199 status = pcs + cfg->regs[QPHY_PCS_READY_STATUS];
1200 ret = readl_poll_timeout(status, val, (val & PCS_READY), PHY_INIT_COMPLETE_TIMEOUT);
1201 if (ret) {
1202 dev_err(phy->dev, "phy initialization timed-out\n");
1203 return ret;
1204 }
1205
1206 return 0;
1207}
1208
1209static int qmp_ufs_power_off(struct phy *phy)
1210{
1211 struct qmp_ufs_priv *qmp = dev_get_priv(phy->dev);
1212 const struct qmp_ufs_cfg *cfg = qmp->cfg;
1213
1214 /* PHY reset */
1215 qphy_setbits(qmp->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET);
1216
1217 /* stop SerDes and Phy-Coding-Sublayer */
1218 qphy_clrbits(qmp->pcs, cfg->regs[QPHY_START_CTRL],
1219 SERDES_START | PCS_START);
1220
1221 /* Put PHY into POWER DOWN state: active low */
1222 qphy_clrbits(qmp->pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL],
1223 SW_PWRDN);
1224
1225 clk_release_all(qmp->clks, qmp->clk_count);
1226
1227 return 0;
1228}
1229
1230static int qmp_ufs_vreg_init(struct udevice *dev, struct qmp_ufs_priv *qmp)
1231{
1232 /* TOFIX: Add regulator support, but they should be voted at boot time already */
1233
1234 return 0;
1235}
1236
1237static int qmp_ufs_reset_init(struct udevice *dev, struct qmp_ufs_priv *qmp)
1238{
1239 const struct qmp_ufs_cfg *cfg = qmp->cfg;
1240 int num = cfg->num_resets;
1241 int i, ret;
1242
1243 qmp->reset_count = 0;
1244 qmp->resets = devm_kcalloc(dev, num, sizeof(*qmp->resets), GFP_KERNEL);
1245 if (!qmp->resets)
1246 return -ENOMEM;
1247
1248 for (i = 0; i < num; i++) {
1249 ret = reset_get_by_index(dev, i, &qmp->resets[i]);
1250 if (ret < 0) {
1251 dev_err(dev, "failed to get reset %d\n", i);
1252 goto reset_get_err;
1253 }
1254
1255 ++qmp->reset_count;
1256 }
1257
1258 return 0;
1259
1260reset_get_err:
1261 ret = reset_release_all(qmp->resets, qmp->reset_count);
1262 if (ret)
1263 dev_warn(dev, "failed to disable all resets\n");
1264
1265 return ret;
1266}
1267
1268static int qmp_ufs_clk_init(struct udevice *dev, struct qmp_ufs_priv *qmp)
1269{
1270 const struct qmp_ufs_cfg *cfg = qmp->cfg;
1271 int num = cfg->num_clks;
1272 int i, ret;
1273
1274 qmp->clk_count = 0;
1275 qmp->clks = devm_kcalloc(dev, num, sizeof(*qmp->clks), GFP_KERNEL);
1276 if (!qmp->clks)
1277 return -ENOMEM;
1278
1279 for (i = 0; i < num; i++) {
1280 ret = clk_get_by_index(dev, i, &qmp->clks[i]);
1281 if (ret < 0)
1282 goto clk_get_err;
1283
1284 ret = clk_enable(&qmp->clks[i]);
1285 if (ret && ret != -ENOSYS) {
1286 dev_err(dev, "failed to enable clock %d\n", i);
1287 goto clk_get_err;
1288 }
1289
1290 ++qmp->clk_count;
1291 }
1292
1293 return 0;
1294
1295clk_get_err:
1296 ret = clk_release_all(qmp->clks, qmp->clk_count);
1297 if (ret)
1298 dev_warn(dev, "failed to disable all clocks\n");
1299
1300 return ret;
1301}
1302
1303static int qmp_ufs_probe_generic_child(struct udevice *dev,
1304 ofnode child)
1305{
1306 struct qmp_ufs_priv *qmp = dev_get_priv(dev);
1307 const struct qmp_ufs_cfg *cfg = qmp->cfg;
1308 struct resource res;
1309 int ret;
1310
1311 /*
1312 * Get memory resources for the PHY:
1313 * Resources are indexed as: tx -> 0; rx -> 1; pcs -> 2.
1314 * For dual lane PHYs: tx2 -> 3, rx2 -> 4, pcs_misc (optional) -> 5
1315 * For single lane PHYs: pcs_misc (optional) -> 3.
1316 */
1317 ret = ofnode_read_resource(child, 0, &res);
1318 if (ret) {
1319 dev_err(dev, "can't get reg property of child %s\n",
1320 ofnode_get_name(child));
1321 return ret;
1322 }
1323
1324 qmp->tx = (void __iomem *)res.start;
1325
1326 ret = ofnode_read_resource(child, 1, &res);
1327 if (ret) {
1328 dev_err(dev, "can't get reg property of child %s\n",
1329 ofnode_get_name(child));
1330 return ret;
1331 }
1332
1333 qmp->rx = (void __iomem *)res.start;
1334
1335 ret = ofnode_read_resource(child, 2, &res);
1336 if (ret) {
1337 dev_err(dev, "can't get reg property of child %s\n",
1338 ofnode_get_name(child));
1339 return ret;
1340 }
1341
1342 qmp->pcs = (void __iomem *)res.start;
1343
1344 if (cfg->lanes >= 2) {
1345 ret = ofnode_read_resource(child, 3, &res);
1346 if (ret) {
1347 dev_err(dev, "can't get reg property of child %s\n",
1348 ofnode_get_name(child));
1349 return ret;
1350 }
1351
1352 qmp->tx2 = (void __iomem *)res.start;
1353
1354 ret = ofnode_read_resource(child, 4, &res);
1355 if (ret) {
1356 dev_err(dev, "can't get reg property of child %s\n",
1357 ofnode_get_name(child));
1358 return ret;
1359 }
1360
1361 qmp->rx2 = (void __iomem *)res.start;
1362
1363 ret = ofnode_read_resource(child, 5, &res);
1364 if (ret)
1365 qmp->pcs_misc = NULL;
1366 } else {
1367 ret = ofnode_read_resource(child, 3, &res);
1368 if (ret)
1369 qmp->pcs_misc = NULL;
1370 }
1371
1372 return 0;
1373}
1374
1375static int qmp_ufs_probe_dt_children(struct udevice *dev)
1376{
1377 int ret;
1378 ofnode child;
1379
1380 ofnode_for_each_subnode(child, dev_ofnode(dev)) {
1381 ret = qmp_ufs_probe_generic_child(dev, child);
1382 if (ret) {
1383 dev_err(dev, "Cannot parse child %s:%d\n",
1384 ofnode_get_name(child), ret);
1385 return ret;
1386 }
1387 }
1388
1389 return 0;
1390}
1391
1392static int qmp_ufs_probe(struct udevice *dev)
1393{
1394 struct qmp_ufs_priv *qmp = dev_get_priv(dev);
1395 int ret;
1396
1397 qmp->serdes = (void __iomem *)dev_read_addr(dev);
1398 if (IS_ERR(qmp->serdes))
1399 return PTR_ERR(qmp->serdes);
1400
1401 qmp->cfg = (const struct qmp_ufs_cfg *)dev_get_driver_data(dev);
1402 if (!qmp->cfg)
1403 return -EINVAL;
1404
1405 ret = qmp_ufs_clk_init(dev, qmp);
1406 if (ret) {
1407 dev_err(dev, "failed to get UFS clks\n");
1408 return ret;
1409 }
1410
1411 ret = qmp_ufs_vreg_init(dev, qmp);
1412 if (ret) {
1413 dev_err(dev, "failed to get UFS voltage regulators\n");
1414 return ret;
1415 }
1416
1417 if (qmp->cfg->no_pcs_sw_reset) {
1418 ret = qmp_ufs_reset_init(dev, qmp);
1419 if (ret) {
1420 dev_err(dev, "failed to get UFS resets\n");
1421 return ret;
1422 }
1423 }
1424
1425 qmp->dev = dev;
1426
1427 if (ofnode_get_child_count(dev_ofnode(dev))) {
1428 ret = qmp_ufs_probe_dt_children(dev);
1429 if (ret) {
1430 dev_err(dev, "failed to get UFS dt regs\n");
1431 return ret;
1432 }
1433 } else {
1434 const struct qmp_ufs_offsets *offs = qmp->cfg->offsets;
1435 struct resource res;
1436
1437 if (!qmp->cfg->offsets) {
1438 dev_err(dev, "missing UFS offsets\n");
1439 return -EINVAL;
1440 }
1441
1442 ret = ofnode_read_resource(dev_ofnode(dev), 0, &res);
1443 if (ret) {
1444 dev_err(dev, "can't get reg property\n");
1445 return ret;
1446 }
1447
1448 qmp->serdes = (void __iomem *)res.start + offs->serdes;
1449 qmp->pcs = (void __iomem *)res.start + offs->pcs;
1450 qmp->tx = (void __iomem *)res.start + offs->tx;
1451 qmp->rx = (void __iomem *)res.start + offs->rx;
1452
1453 if (qmp->cfg->lanes >= 2) {
1454 qmp->tx2 = (void __iomem *)res.start + offs->tx2;
1455 qmp->rx2 = (void __iomem *)res.start + offs->rx2;
1456 }
1457 }
1458
1459 return 0;
1460}
1461
1462static struct phy_ops qmp_ufs_ops = {
1463 .power_on = qmp_ufs_power_on,
1464 .power_off = qmp_ufs_power_off,
1465};
1466
1467static const struct udevice_id qmp_ufs_ids[] = {
Varadarajan Narayananbcf49ae2025-01-10 10:38:15 +05301468 { .compatible = "qcom,sa8775p-qmp-ufs-phy", .data = (ulong)&sa8775p_ufsphy_cfg, },
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +02001469 { .compatible = "qcom,sdm845-qmp-ufs-phy", .data = (ulong)&sdm845_ufsphy_cfg },
Julius Lehmann425a9122024-10-02 20:52:17 +02001470 { .compatible = "qcom,sm8150-qmp-ufs-phy", .data = (ulong)&sm8150_ufsphy_cfg },
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +02001471 { .compatible = "qcom,sm8250-qmp-ufs-phy", .data = (ulong)&sm8250_ufsphy_cfg },
1472 { .compatible = "qcom,sm8550-qmp-ufs-phy", .data = (ulong)&sm8550_ufsphy_cfg },
1473 { .compatible = "qcom,sm8650-qmp-ufs-phy", .data = (ulong)&sm8650_ufsphy_cfg },
Caleb Connollyf2021a22024-10-12 15:22:05 +02001474 { .compatible = "qcom,sc7280-qmp-ufs-phy", .data = (ulong)&sc7280_ufsphy_cfg, },
Bhupesh Sharmaf0cbbc92024-09-10 11:11:58 +02001475 { }
1476};
1477
1478U_BOOT_DRIVER(qcom_qmp_ufs) = {
1479 .name = "qcom-qmp-ufs",
1480 .id = UCLASS_PHY,
1481 .of_match = qmp_ufs_ids,
1482 .ops = &qmp_ufs_ops,
1483 .probe = qmp_ufs_probe,
1484 .priv_auto = sizeof(struct qmp_ufs_priv),
1485};