1
2
3
4
5
6#include <linux/clk.h>
7#include <linux/clk-provider.h>
8#include <linux/delay.h>
9#include <linux/err.h>
10#include <linux/io.h>
11#include <linux/iopoll.h>
12#include <linux/kernel.h>
13#include <linux/module.h>
14#include <linux/of.h>
15#include <linux/of_device.h>
16#include <linux/of_address.h>
17#include <linux/phy/phy.h>
18#include <linux/platform_device.h>
19#include <linux/regulator/consumer.h>
20#include <linux/reset.h>
21#include <linux/slab.h>
22
23#include <dt-bindings/phy/phy.h>
24
25#include "phy-qcom-qmp.h"
26
27
28#define SW_RESET BIT(0)
29
30#define SW_PWRDN BIT(0)
31#define REFCLK_DRV_DSBL BIT(1)
32
33#define SERDES_START BIT(0)
34#define PCS_START BIT(1)
35#define PLL_READY_GATE_EN BIT(3)
36
37#define PHYSTATUS BIT(6)
38
39#define PCS_READY BIT(0)
40
41
42
43#define SW_DPPHY_RESET BIT(0)
44
45#define SW_DPPHY_RESET_MUX BIT(1)
46
47#define SW_USB3PHY_RESET BIT(2)
48
49#define SW_USB3PHY_RESET_MUX BIT(3)
50
51
52#define USB3_MODE BIT(0)
53#define DP_MODE BIT(1)
54
55
56#define ARCVR_DTCT_EN BIT(0)
57#define ALFPS_DTCT_EN BIT(1)
58#define ARCVR_DTCT_EVENT_SEL BIT(4)
59
60
61#define IRQ_CLEAR BIT(0)
62
63
64#define RCVR_DETECT BIT(0)
65
66
67#define CLAMP_EN BIT(0)
68
69#define PHY_INIT_COMPLETE_TIMEOUT 1000
70#define POWER_DOWN_DELAY_US_MIN 10
71#define POWER_DOWN_DELAY_US_MAX 11
72
73#define MAX_PROP_NAME 32
74
75
76#define QMP_PHY_LEGACY_LANE_STRIDE 0x400
77
78struct qmp_phy_init_tbl {
79 unsigned int offset;
80 unsigned int val;
81
82
83
84
85 int in_layout;
86};
87
88#define QMP_PHY_INIT_CFG(o, v) \
89 { \
90 .offset = o, \
91 .val = v, \
92 }
93
94#define QMP_PHY_INIT_CFG_L(o, v) \
95 { \
96 .offset = o, \
97 .val = v, \
98 .in_layout = 1, \
99 }
100
101
102enum qphy_reg_layout {
103
104 QPHY_COM_SW_RESET,
105 QPHY_COM_POWER_DOWN_CONTROL,
106 QPHY_COM_START_CONTROL,
107 QPHY_COM_PCS_READY_STATUS,
108
109 QPHY_PLL_LOCK_CHK_DLY_TIME,
110 QPHY_FLL_CNTRL1,
111 QPHY_FLL_CNTRL2,
112 QPHY_FLL_CNT_VAL_L,
113 QPHY_FLL_CNT_VAL_H_TOL,
114 QPHY_FLL_MAN_CODE,
115 QPHY_SW_RESET,
116 QPHY_START_CTRL,
117 QPHY_PCS_READY_STATUS,
118 QPHY_PCS_AUTONOMOUS_MODE_CTRL,
119 QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR,
120 QPHY_PCS_LFPS_RXTERM_IRQ_STATUS,
121};
122
123static const unsigned int pciephy_regs_layout[] = {
124 [QPHY_COM_SW_RESET] = 0x400,
125 [QPHY_COM_POWER_DOWN_CONTROL] = 0x404,
126 [QPHY_COM_START_CONTROL] = 0x408,
127 [QPHY_COM_PCS_READY_STATUS] = 0x448,
128 [QPHY_PLL_LOCK_CHK_DLY_TIME] = 0xa8,
129 [QPHY_FLL_CNTRL1] = 0xc4,
130 [QPHY_FLL_CNTRL2] = 0xc8,
131 [QPHY_FLL_CNT_VAL_L] = 0xcc,
132 [QPHY_FLL_CNT_VAL_H_TOL] = 0xd0,
133 [QPHY_FLL_MAN_CODE] = 0xd4,
134 [QPHY_SW_RESET] = 0x00,
135 [QPHY_START_CTRL] = 0x08,
136 [QPHY_PCS_READY_STATUS] = 0x174,
137};
138
139static const unsigned int usb3phy_regs_layout[] = {
140 [QPHY_FLL_CNTRL1] = 0xc0,
141 [QPHY_FLL_CNTRL2] = 0xc4,
142 [QPHY_FLL_CNT_VAL_L] = 0xc8,
143 [QPHY_FLL_CNT_VAL_H_TOL] = 0xcc,
144 [QPHY_FLL_MAN_CODE] = 0xd0,
145 [QPHY_SW_RESET] = 0x00,
146 [QPHY_START_CTRL] = 0x08,
147 [QPHY_PCS_READY_STATUS] = 0x17c,
148 [QPHY_PCS_AUTONOMOUS_MODE_CTRL] = 0x0d4,
149 [QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR] = 0x0d8,
150 [QPHY_PCS_LFPS_RXTERM_IRQ_STATUS] = 0x178,
151};
152
153static const unsigned int qmp_v3_usb3phy_regs_layout[] = {
154 [QPHY_SW_RESET] = 0x00,
155 [QPHY_START_CTRL] = 0x08,
156 [QPHY_PCS_READY_STATUS] = 0x174,
157 [QPHY_PCS_AUTONOMOUS_MODE_CTRL] = 0x0d8,
158 [QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR] = 0x0dc,
159 [QPHY_PCS_LFPS_RXTERM_IRQ_STATUS] = 0x170,
160};
161
162static const unsigned int sdm845_ufsphy_regs_layout[] = {
163 [QPHY_START_CTRL] = 0x00,
164 [QPHY_PCS_READY_STATUS] = 0x160,
165};
166
167static const struct qmp_phy_init_tbl msm8996_pcie_serdes_tbl[] = {
168 QMP_PHY_INIT_CFG(QSERDES_COM_BIAS_EN_CLKBUFLR_EN, 0x1c),
169 QMP_PHY_INIT_CFG(QSERDES_COM_CLK_ENABLE1, 0x10),
170 QMP_PHY_INIT_CFG(QSERDES_COM_CLK_SELECT, 0x33),
171 QMP_PHY_INIT_CFG(QSERDES_COM_CMN_CONFIG, 0x06),
172 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP_EN, 0x42),
173 QMP_PHY_INIT_CFG(QSERDES_COM_VCO_TUNE_MAP, 0x00),
174 QMP_PHY_INIT_CFG(QSERDES_COM_VCO_TUNE_TIMER1, 0xff),
175 QMP_PHY_INIT_CFG(QSERDES_COM_VCO_TUNE_TIMER2, 0x1f),
176 QMP_PHY_INIT_CFG(QSERDES_COM_HSCLK_SEL, 0x01),
177 QMP_PHY_INIT_CFG(QSERDES_COM_SVS_MODE_CLK_SEL, 0x01),
178 QMP_PHY_INIT_CFG(QSERDES_COM_CORE_CLK_EN, 0x00),
179 QMP_PHY_INIT_CFG(QSERDES_COM_CORECLK_DIV, 0x0a),
180 QMP_PHY_INIT_CFG(QSERDES_COM_BG_TIMER, 0x09),
181 QMP_PHY_INIT_CFG(QSERDES_COM_DEC_START_MODE0, 0x82),
182 QMP_PHY_INIT_CFG(QSERDES_COM_DIV_FRAC_START3_MODE0, 0x03),
183 QMP_PHY_INIT_CFG(QSERDES_COM_DIV_FRAC_START2_MODE0, 0x55),
184 QMP_PHY_INIT_CFG(QSERDES_COM_DIV_FRAC_START1_MODE0, 0x55),
185 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP3_MODE0, 0x00),
186 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP2_MODE0, 0x1a),
187 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP1_MODE0, 0x0a),
188 QMP_PHY_INIT_CFG(QSERDES_COM_CLK_SELECT, 0x33),
189 QMP_PHY_INIT_CFG(QSERDES_COM_SYS_CLK_CTRL, 0x02),
190 QMP_PHY_INIT_CFG(QSERDES_COM_SYSCLK_BUF_ENABLE, 0x1f),
191 QMP_PHY_INIT_CFG(QSERDES_COM_SYSCLK_EN_SEL, 0x04),
192 QMP_PHY_INIT_CFG(QSERDES_COM_CP_CTRL_MODE0, 0x0b),
193 QMP_PHY_INIT_CFG(QSERDES_COM_PLL_RCTRL_MODE0, 0x16),
194 QMP_PHY_INIT_CFG(QSERDES_COM_PLL_CCTRL_MODE0, 0x28),
195 QMP_PHY_INIT_CFG(QSERDES_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
196 QMP_PHY_INIT_CFG(QSERDES_COM_INTEGLOOP_GAIN0_MODE0, 0x80),
197 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_EN_CENTER, 0x01),
198 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_PER1, 0x31),
199 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_PER2, 0x01),
200 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_ADJ_PER1, 0x02),
201 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_ADJ_PER2, 0x00),
202 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_STEP_SIZE1, 0x2f),
203 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_STEP_SIZE2, 0x19),
204 QMP_PHY_INIT_CFG(QSERDES_COM_RESCODE_DIV_NUM, 0x15),
205 QMP_PHY_INIT_CFG(QSERDES_COM_BG_TRIM, 0x0f),
206 QMP_PHY_INIT_CFG(QSERDES_COM_PLL_IVCO, 0x0f),
207 QMP_PHY_INIT_CFG(QSERDES_COM_CLK_EP_DIV, 0x19),
208 QMP_PHY_INIT_CFG(QSERDES_COM_CLK_ENABLE1, 0x10),
209 QMP_PHY_INIT_CFG(QSERDES_COM_HSCLK_SEL, 0x00),
210 QMP_PHY_INIT_CFG(QSERDES_COM_RESCODE_DIV_NUM, 0x40),
211};
212
213static const struct qmp_phy_init_tbl msm8996_pcie_tx_tbl[] = {
214 QMP_PHY_INIT_CFG(QSERDES_TX_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN, 0x45),
215 QMP_PHY_INIT_CFG(QSERDES_TX_LANE_MODE, 0x06),
216};
217
218static const struct qmp_phy_init_tbl msm8996_pcie_rx_tbl[] = {
219 QMP_PHY_INIT_CFG(QSERDES_RX_SIGDET_ENABLES, 0x1c),
220 QMP_PHY_INIT_CFG(QSERDES_RX_RX_EQU_ADAPTOR_CNTRL2, 0x01),
221 QMP_PHY_INIT_CFG(QSERDES_RX_RX_EQU_ADAPTOR_CNTRL3, 0x00),
222 QMP_PHY_INIT_CFG(QSERDES_RX_RX_EQU_ADAPTOR_CNTRL4, 0xdb),
223 QMP_PHY_INIT_CFG(QSERDES_RX_RX_BAND, 0x18),
224 QMP_PHY_INIT_CFG(QSERDES_RX_UCDR_SO_GAIN, 0x04),
225 QMP_PHY_INIT_CFG(QSERDES_RX_UCDR_SO_GAIN_HALF, 0x04),
226 QMP_PHY_INIT_CFG(QSERDES_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x4b),
227 QMP_PHY_INIT_CFG(QSERDES_RX_SIGDET_DEGLITCH_CNTRL, 0x14),
228 QMP_PHY_INIT_CFG(QSERDES_RX_SIGDET_LVL, 0x19),
229};
230
231static const struct qmp_phy_init_tbl msm8996_pcie_pcs_tbl[] = {
232 QMP_PHY_INIT_CFG(QPHY_RX_IDLE_DTCT_CNTRL, 0x4c),
233 QMP_PHY_INIT_CFG(QPHY_PWRUP_RESET_DLY_TIME_AUXCLK, 0x00),
234 QMP_PHY_INIT_CFG(QPHY_LP_WAKEUP_DLY_TIME_AUXCLK, 0x01),
235
236 QMP_PHY_INIT_CFG_L(QPHY_PLL_LOCK_CHK_DLY_TIME, 0x05),
237
238 QMP_PHY_INIT_CFG(QPHY_ENDPOINT_REFCLK_DRIVE, 0x05),
239 QMP_PHY_INIT_CFG(QPHY_POWER_DOWN_CONTROL, 0x02),
240 QMP_PHY_INIT_CFG(QPHY_POWER_STATE_CONFIG4, 0x00),
241 QMP_PHY_INIT_CFG(QPHY_POWER_STATE_CONFIG1, 0xa3),
242 QMP_PHY_INIT_CFG(QPHY_TXDEEMPH_M3P5DB_V0, 0x0e),
243};
244
245static const struct qmp_phy_init_tbl msm8998_pcie_serdes_tbl[] = {
246 QMP_PHY_INIT_CFG(QSERDES_V3_COM_BIAS_EN_CLKBUFLR_EN, 0x14),
247 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_SELECT, 0x30),
248 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_IVCO, 0x0f),
249 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CMN_CONFIG, 0x06),
250 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_EN, 0x01),
251 QMP_PHY_INIT_CFG(QSERDES_V3_COM_RESETSM_CNTRL, 0x20),
252 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_MAP, 0x00),
253 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE2_MODE0, 0x01),
254 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE1_MODE0, 0xc9),
255 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_TIMER1, 0xff),
256 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_TIMER2, 0x3f),
257 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SVS_MODE_CLK_SEL, 0x01),
258 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORE_CLK_EN, 0x00),
259 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORECLK_DIV_MODE0, 0x0a),
260 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_EP_DIV, 0x19),
261 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_ENABLE1, 0x90),
262 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE0, 0x82),
263 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START3_MODE0, 0x03),
264 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START2_MODE0, 0x55),
265 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START1_MODE0, 0x55),
266 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP3_MODE0, 0x00),
267 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE0, 0x0d),
268 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE0, 0x04),
269 QMP_PHY_INIT_CFG(QSERDES_V3_COM_HSCLK_SEL, 0x00),
270 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CP_CTRL_MODE0, 0x08),
271 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_RCTRL_MODE0, 0x16),
272 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_CCTRL_MODE0, 0x34),
273 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CMN_CONFIG, 0x06),
274 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_SELECT, 0x33),
275 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYS_CLK_CTRL, 0x02),
276 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_BUF_ENABLE, 0x07),
277 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_EN_SEL, 0x04),
278 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
279 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN0_MODE0, 0x3f),
280 QMP_PHY_INIT_CFG(QSERDES_V3_COM_BG_TIMER, 0x09),
281 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_EN_CENTER, 0x01),
282 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_PER1, 0x40),
283 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_PER2, 0x01),
284 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_ADJ_PER1, 0x02),
285 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_ADJ_PER2, 0x00),
286 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_STEP_SIZE1, 0x7e),
287 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_STEP_SIZE2, 0x15),
288};
289
290static const struct qmp_phy_init_tbl msm8998_pcie_tx_tbl[] = {
291 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX, 0x02),
292 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RCV_DETECT_LVL_2, 0x12),
293 QMP_PHY_INIT_CFG(QSERDES_V3_TX_HIGHZ_DRVR_EN, 0x10),
294 QMP_PHY_INIT_CFG(QSERDES_V3_TX_LANE_MODE_1, 0x06),
295};
296
297static const struct qmp_phy_init_tbl msm8998_pcie_rx_tbl[] = {
298 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_CNTRL, 0x03),
299 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_ENABLES, 0x1c),
300 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_DEGLITCH_CNTRL, 0x14),
301 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL2, 0x0a),
302 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL3, 0x04),
303 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL4, 0x1a),
304 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x4b),
305 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SO_GAIN, 0x04),
306 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SO_GAIN_HALF, 0x04),
307 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x00),
308 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_OFFSET_ADAPTOR_CNTRL2, 0x80),
309 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_INTERFACE_MODE, 0x40),
310 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_PI_CONTROLS, 0x71),
311 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_COUNT_LOW, 0x40),
312};
313
314static const struct qmp_phy_init_tbl msm8998_pcie_pcs_tbl[] = {
315 QMP_PHY_INIT_CFG(QPHY_V3_PCS_ENDPOINT_REFCLK_DRIVE, 0x04),
316 QMP_PHY_INIT_CFG(QPHY_V3_PCS_OSC_DTCT_ACTIONS, 0x00),
317 QMP_PHY_INIT_CFG(QPHY_V3_PCS_PWRUP_RESET_DLY_TIME_AUXCLK, 0x01),
318 QMP_PHY_INIT_CFG(QPHY_V3_PCS_L1SS_WAKEUP_DLY_TIME_AUXCLK_MSB, 0x00),
319 QMP_PHY_INIT_CFG(QPHY_V3_PCS_L1SS_WAKEUP_DLY_TIME_AUXCLK_LSB, 0x20),
320 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LP_WAKEUP_DLY_TIME_AUXCLK_MSB, 0x00),
321 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LP_WAKEUP_DLY_TIME_AUXCLK, 0x01),
322 QMP_PHY_INIT_CFG(QPHY_V3_PCS_PLL_LOCK_CHK_DLY_TIME, 0x73),
323 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SIGDET_LVL, 0x99),
324 QMP_PHY_INIT_CFG(QPHY_V3_PCS_SIGDET_CNTRL, 0x03),
325};
326
327static const struct qmp_phy_init_tbl msm8996_usb3_serdes_tbl[] = {
328 QMP_PHY_INIT_CFG(QSERDES_COM_SYSCLK_EN_SEL, 0x14),
329 QMP_PHY_INIT_CFG(QSERDES_COM_BIAS_EN_CLKBUFLR_EN, 0x08),
330 QMP_PHY_INIT_CFG(QSERDES_COM_CLK_SELECT, 0x30),
331 QMP_PHY_INIT_CFG(QSERDES_COM_CMN_CONFIG, 0x06),
332 QMP_PHY_INIT_CFG(QSERDES_COM_SVS_MODE_CLK_SEL, 0x01),
333 QMP_PHY_INIT_CFG(QSERDES_COM_HSCLK_SEL, 0x00),
334 QMP_PHY_INIT_CFG(QSERDES_COM_BG_TRIM, 0x0f),
335 QMP_PHY_INIT_CFG(QSERDES_COM_PLL_IVCO, 0x0f),
336 QMP_PHY_INIT_CFG(QSERDES_COM_SYS_CLK_CTRL, 0x04),
337
338 QMP_PHY_INIT_CFG(QSERDES_COM_DEC_START_MODE0, 0x82),
339 QMP_PHY_INIT_CFG(QSERDES_COM_DIV_FRAC_START1_MODE0, 0x55),
340 QMP_PHY_INIT_CFG(QSERDES_COM_DIV_FRAC_START2_MODE0, 0x55),
341 QMP_PHY_INIT_CFG(QSERDES_COM_DIV_FRAC_START3_MODE0, 0x03),
342 QMP_PHY_INIT_CFG(QSERDES_COM_CP_CTRL_MODE0, 0x0b),
343 QMP_PHY_INIT_CFG(QSERDES_COM_PLL_RCTRL_MODE0, 0x16),
344 QMP_PHY_INIT_CFG(QSERDES_COM_PLL_CCTRL_MODE0, 0x28),
345 QMP_PHY_INIT_CFG(QSERDES_COM_INTEGLOOP_GAIN0_MODE0, 0x80),
346 QMP_PHY_INIT_CFG(QSERDES_COM_VCO_TUNE_CTRL, 0x00),
347 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP1_MODE0, 0x15),
348 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP2_MODE0, 0x34),
349 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP3_MODE0, 0x00),
350 QMP_PHY_INIT_CFG(QSERDES_COM_CORE_CLK_EN, 0x00),
351 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP_CFG, 0x00),
352 QMP_PHY_INIT_CFG(QSERDES_COM_VCO_TUNE_MAP, 0x00),
353 QMP_PHY_INIT_CFG(QSERDES_COM_BG_TIMER, 0x0a),
354
355 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_EN_CENTER, 0x01),
356 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_PER1, 0x31),
357 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_PER2, 0x01),
358 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_ADJ_PER1, 0x00),
359 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_ADJ_PER2, 0x00),
360 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_STEP_SIZE1, 0xde),
361 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_STEP_SIZE2, 0x07),
362};
363
364static const struct qmp_phy_init_tbl msm8996_usb3_tx_tbl[] = {
365 QMP_PHY_INIT_CFG(QSERDES_TX_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN, 0x45),
366 QMP_PHY_INIT_CFG(QSERDES_TX_RCV_DETECT_LVL_2, 0x12),
367 QMP_PHY_INIT_CFG(QSERDES_TX_LANE_MODE, 0x06),
368};
369
370static const struct qmp_phy_init_tbl msm8996_usb3_rx_tbl[] = {
371 QMP_PHY_INIT_CFG(QSERDES_RX_UCDR_FASTLOCK_FO_GAIN, 0x0b),
372 QMP_PHY_INIT_CFG(QSERDES_RX_UCDR_SO_GAIN, 0x04),
373 QMP_PHY_INIT_CFG(QSERDES_RX_RX_EQU_ADAPTOR_CNTRL2, 0x02),
374 QMP_PHY_INIT_CFG(QSERDES_RX_RX_EQU_ADAPTOR_CNTRL3, 0x4c),
375 QMP_PHY_INIT_CFG(QSERDES_RX_RX_EQU_ADAPTOR_CNTRL4, 0xbb),
376 QMP_PHY_INIT_CFG(QSERDES_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x77),
377 QMP_PHY_INIT_CFG(QSERDES_RX_RX_OFFSET_ADAPTOR_CNTRL2, 0x80),
378 QMP_PHY_INIT_CFG(QSERDES_RX_SIGDET_CNTRL, 0x03),
379 QMP_PHY_INIT_CFG(QSERDES_RX_SIGDET_LVL, 0x18),
380 QMP_PHY_INIT_CFG(QSERDES_RX_SIGDET_DEGLITCH_CNTRL, 0x16),
381};
382
383static const struct qmp_phy_init_tbl msm8996_usb3_pcs_tbl[] = {
384
385 QMP_PHY_INIT_CFG_L(QPHY_FLL_CNTRL2, 0x03),
386 QMP_PHY_INIT_CFG_L(QPHY_FLL_CNTRL1, 0x02),
387 QMP_PHY_INIT_CFG_L(QPHY_FLL_CNT_VAL_L, 0x09),
388 QMP_PHY_INIT_CFG_L(QPHY_FLL_CNT_VAL_H_TOL, 0x42),
389 QMP_PHY_INIT_CFG_L(QPHY_FLL_MAN_CODE, 0x85),
390
391
392 QMP_PHY_INIT_CFG(QPHY_LOCK_DETECT_CONFIG1, 0xd1),
393 QMP_PHY_INIT_CFG(QPHY_LOCK_DETECT_CONFIG2, 0x1f),
394 QMP_PHY_INIT_CFG(QPHY_LOCK_DETECT_CONFIG3, 0x47),
395 QMP_PHY_INIT_CFG(QPHY_POWER_STATE_CONFIG2, 0x08),
396};
397
398static const struct qmp_phy_init_tbl ipq8074_pcie_serdes_tbl[] = {
399 QMP_PHY_INIT_CFG(QSERDES_COM_BIAS_EN_CLKBUFLR_EN, 0x18),
400 QMP_PHY_INIT_CFG(QSERDES_COM_CLK_ENABLE1, 0x10),
401 QMP_PHY_INIT_CFG(QSERDES_COM_BG_TRIM, 0xf),
402 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP_EN, 0x1),
403 QMP_PHY_INIT_CFG(QSERDES_COM_VCO_TUNE_MAP, 0x0),
404 QMP_PHY_INIT_CFG(QSERDES_COM_VCO_TUNE_TIMER1, 0x1f),
405 QMP_PHY_INIT_CFG(QSERDES_COM_VCO_TUNE_TIMER2, 0x3f),
406 QMP_PHY_INIT_CFG(QSERDES_COM_CMN_CONFIG, 0x6),
407 QMP_PHY_INIT_CFG(QSERDES_COM_PLL_IVCO, 0xf),
408 QMP_PHY_INIT_CFG(QSERDES_COM_HSCLK_SEL, 0x0),
409 QMP_PHY_INIT_CFG(QSERDES_COM_SVS_MODE_CLK_SEL, 0x1),
410 QMP_PHY_INIT_CFG(QSERDES_COM_CORE_CLK_EN, 0x20),
411 QMP_PHY_INIT_CFG(QSERDES_COM_CORECLK_DIV, 0xa),
412 QMP_PHY_INIT_CFG(QSERDES_COM_RESETSM_CNTRL, 0x20),
413 QMP_PHY_INIT_CFG(QSERDES_COM_BG_TIMER, 0xa),
414 QMP_PHY_INIT_CFG(QSERDES_COM_SYSCLK_EN_SEL, 0xa),
415 QMP_PHY_INIT_CFG(QSERDES_COM_DEC_START_MODE0, 0x82),
416 QMP_PHY_INIT_CFG(QSERDES_COM_DIV_FRAC_START3_MODE0, 0x3),
417 QMP_PHY_INIT_CFG(QSERDES_COM_DIV_FRAC_START2_MODE0, 0x55),
418 QMP_PHY_INIT_CFG(QSERDES_COM_DIV_FRAC_START1_MODE0, 0x55),
419 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP3_MODE0, 0x0),
420 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP2_MODE0, 0xD),
421 QMP_PHY_INIT_CFG(QSERDES_COM_LOCK_CMP1_MODE0, 0xD04),
422 QMP_PHY_INIT_CFG(QSERDES_COM_CLK_SELECT, 0x33),
423 QMP_PHY_INIT_CFG(QSERDES_COM_SYS_CLK_CTRL, 0x2),
424 QMP_PHY_INIT_CFG(QSERDES_COM_SYSCLK_BUF_ENABLE, 0x1f),
425 QMP_PHY_INIT_CFG(QSERDES_COM_CP_CTRL_MODE0, 0xb),
426 QMP_PHY_INIT_CFG(QSERDES_COM_PLL_RCTRL_MODE0, 0x16),
427 QMP_PHY_INIT_CFG(QSERDES_COM_PLL_CCTRL_MODE0, 0x28),
428 QMP_PHY_INIT_CFG(QSERDES_COM_INTEGLOOP_GAIN1_MODE0, 0x0),
429 QMP_PHY_INIT_CFG(QSERDES_COM_INTEGLOOP_GAIN0_MODE0, 0x80),
430 QMP_PHY_INIT_CFG(QSERDES_COM_BIAS_EN_CTRL_BY_PSM, 0x1),
431 QMP_PHY_INIT_CFG(QSERDES_COM_VCO_TUNE_CTRL, 0xa),
432 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_EN_CENTER, 0x1),
433 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_PER1, 0x31),
434 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_PER2, 0x1),
435 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_ADJ_PER1, 0x2),
436 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_ADJ_PER2, 0x0),
437 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_STEP_SIZE1, 0x2f),
438 QMP_PHY_INIT_CFG(QSERDES_COM_SSC_STEP_SIZE2, 0x19),
439 QMP_PHY_INIT_CFG(QSERDES_COM_CLK_EP_DIV, 0x19),
440 QMP_PHY_INIT_CFG(QSERDES_RX_SIGDET_CNTRL, 0x7),
441};
442
443static const struct qmp_phy_init_tbl ipq8074_pcie_tx_tbl[] = {
444 QMP_PHY_INIT_CFG(QSERDES_TX_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN, 0x45),
445 QMP_PHY_INIT_CFG(QSERDES_TX_LANE_MODE, 0x6),
446 QMP_PHY_INIT_CFG(QSERDES_TX_RES_CODE_LANE_OFFSET, 0x2),
447 QMP_PHY_INIT_CFG(QSERDES_TX_RCV_DETECT_LVL_2, 0x12),
448};
449
450static const struct qmp_phy_init_tbl ipq8074_pcie_rx_tbl[] = {
451 QMP_PHY_INIT_CFG(QSERDES_RX_SIGDET_ENABLES, 0x1c),
452 QMP_PHY_INIT_CFG(QSERDES_RX_SIGDET_DEGLITCH_CNTRL, 0x14),
453 QMP_PHY_INIT_CFG(QSERDES_RX_RX_EQU_ADAPTOR_CNTRL2, 0x1),
454 QMP_PHY_INIT_CFG(QSERDES_RX_RX_EQU_ADAPTOR_CNTRL3, 0x0),
455 QMP_PHY_INIT_CFG(QSERDES_RX_RX_EQU_ADAPTOR_CNTRL4, 0xdb),
456 QMP_PHY_INIT_CFG(QSERDES_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x4b),
457 QMP_PHY_INIT_CFG(QSERDES_RX_UCDR_SO_GAIN, 0x4),
458 QMP_PHY_INIT_CFG(QSERDES_RX_UCDR_SO_GAIN_HALF, 0x4),
459};
460
461static const struct qmp_phy_init_tbl ipq8074_pcie_pcs_tbl[] = {
462 QMP_PHY_INIT_CFG(QPHY_ENDPOINT_REFCLK_DRIVE, 0x4),
463 QMP_PHY_INIT_CFG(QPHY_OSC_DTCT_ACTIONS, 0x0),
464 QMP_PHY_INIT_CFG(QPHY_PWRUP_RESET_DLY_TIME_AUXCLK, 0x40),
465 QMP_PHY_INIT_CFG(QPHY_L1SS_WAKEUP_DLY_TIME_AUXCLK_MSB, 0x0),
466 QMP_PHY_INIT_CFG(QPHY_L1SS_WAKEUP_DLY_TIME_AUXCLK_LSB, 0x40),
467 QMP_PHY_INIT_CFG(QPHY_PLL_LOCK_CHK_DLY_TIME_AUXCLK_LSB, 0x0),
468 QMP_PHY_INIT_CFG(QPHY_LP_WAKEUP_DLY_TIME_AUXCLK, 0x40),
469 QMP_PHY_INIT_CFG_L(QPHY_PLL_LOCK_CHK_DLY_TIME, 0x73),
470 QMP_PHY_INIT_CFG(QPHY_RX_SIGDET_LVL, 0x99),
471 QMP_PHY_INIT_CFG(QPHY_TXDEEMPH_M6DB_V0, 0x15),
472 QMP_PHY_INIT_CFG(QPHY_TXDEEMPH_M3P5DB_V0, 0xe),
473 QMP_PHY_INIT_CFG_L(QPHY_SW_RESET, 0x0),
474 QMP_PHY_INIT_CFG_L(QPHY_START_CTRL, 0x3),
475};
476
477static const struct qmp_phy_init_tbl qmp_v3_usb3_serdes_tbl[] = {
478 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_IVCO, 0x07),
479 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_EN_SEL, 0x14),
480 QMP_PHY_INIT_CFG(QSERDES_V3_COM_BIAS_EN_CLKBUFLR_EN, 0x08),
481 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_SELECT, 0x30),
482 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYS_CLK_CTRL, 0x02),
483 QMP_PHY_INIT_CFG(QSERDES_V3_COM_RESETSM_CNTRL2, 0x08),
484 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CMN_CONFIG, 0x16),
485 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SVS_MODE_CLK_SEL, 0x01),
486 QMP_PHY_INIT_CFG(QSERDES_V3_COM_HSCLK_SEL, 0x80),
487 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE0, 0x82),
488 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START1_MODE0, 0xab),
489 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START2_MODE0, 0xea),
490 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START3_MODE0, 0x02),
491 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CP_CTRL_MODE0, 0x06),
492 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_RCTRL_MODE0, 0x16),
493 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_CCTRL_MODE0, 0x36),
494 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
495 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN0_MODE0, 0x3f),
496 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE2_MODE0, 0x01),
497 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE1_MODE0, 0xc9),
498 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORECLK_DIV_MODE0, 0x0a),
499 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP3_MODE0, 0x00),
500 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE0, 0x34),
501 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE0, 0x15),
502 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_EN, 0x04),
503 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORE_CLK_EN, 0x00),
504 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_CFG, 0x00),
505 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_MAP, 0x00),
506 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_BUF_ENABLE, 0x0a),
507 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_EN_CENTER, 0x01),
508 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_PER1, 0x31),
509 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_PER2, 0x01),
510 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_ADJ_PER1, 0x00),
511 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_ADJ_PER2, 0x00),
512 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_STEP_SIZE1, 0x85),
513 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_STEP_SIZE2, 0x07),
514};
515
516static const struct qmp_phy_init_tbl qmp_v3_usb3_tx_tbl[] = {
517 QMP_PHY_INIT_CFG(QSERDES_V3_TX_HIGHZ_DRVR_EN, 0x10),
518 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RCV_DETECT_LVL_2, 0x12),
519 QMP_PHY_INIT_CFG(QSERDES_V3_TX_LANE_MODE_1, 0x16),
520 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX, 0x09),
521 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX, 0x06),
522};
523
524static const struct qmp_phy_init_tbl qmp_v3_usb3_rx_tbl[] = {
525 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_FO_GAIN, 0x0b),
526 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL2, 0x0f),
527 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL3, 0x4e),
528 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL4, 0x18),
529 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x77),
530 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_OFFSET_ADAPTOR_CNTRL2, 0x80),
531 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_CNTRL, 0x03),
532 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_DEGLITCH_CNTRL, 0x16),
533 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x75),
534};
535
536static const struct qmp_phy_init_tbl qmp_v3_usb3_pcs_tbl[] = {
537
538 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNTRL2, 0x83),
539 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNT_VAL_L, 0x09),
540 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNT_VAL_H_TOL, 0xa2),
541 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_MAN_CODE, 0x40),
542 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNTRL1, 0x02),
543
544
545 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG1, 0xd1),
546 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG2, 0x1f),
547 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG3, 0x47),
548 QMP_PHY_INIT_CFG(QPHY_V3_PCS_POWER_STATE_CONFIG2, 0x1b),
549
550 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SIGDET_LVL, 0xba),
551 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V0, 0x9f),
552 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V1, 0x9f),
553 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V2, 0xb7),
554 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V3, 0x4e),
555 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V4, 0x65),
556 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_LS, 0x6b),
557 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V0, 0x15),
558 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V0, 0x0d),
559 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V1, 0x15),
560 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V1, 0x0d),
561 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V2, 0x15),
562 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V2, 0x0d),
563 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V3, 0x15),
564 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V3, 0x1d),
565 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V4, 0x15),
566 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V4, 0x0d),
567 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_LS, 0x15),
568 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_LS, 0x0d),
569
570 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RATE_SLEW_CNTRL, 0x02),
571 QMP_PHY_INIT_CFG(QPHY_V3_PCS_PWRUP_RESET_DLY_TIME_AUXCLK, 0x04),
572 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TSYNC_RSYNC_TIME, 0x44),
573 QMP_PHY_INIT_CFG(QPHY_V3_PCS_PWRUP_RESET_DLY_TIME_AUXCLK, 0x04),
574 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_P1U2_L, 0xe7),
575 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_P1U2_H, 0x03),
576 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_U3_L, 0x40),
577 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_U3_H, 0x00),
578 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RXEQTRAINING_WAIT_TIME, 0x75),
579 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LFPS_TX_ECSTART_EQTLOCK, 0x86),
580 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RXEQTRAINING_RUN_TIME, 0x13),
581};
582
583static const struct qmp_phy_init_tbl qmp_v3_usb3_uniphy_serdes_tbl[] = {
584 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_IVCO, 0x07),
585 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_EN_SEL, 0x14),
586 QMP_PHY_INIT_CFG(QSERDES_V3_COM_BIAS_EN_CLKBUFLR_EN, 0x04),
587 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_SELECT, 0x30),
588 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYS_CLK_CTRL, 0x02),
589 QMP_PHY_INIT_CFG(QSERDES_V3_COM_RESETSM_CNTRL2, 0x08),
590 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CMN_CONFIG, 0x06),
591 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SVS_MODE_CLK_SEL, 0x01),
592 QMP_PHY_INIT_CFG(QSERDES_V3_COM_HSCLK_SEL, 0x80),
593 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE0, 0x82),
594 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START1_MODE0, 0xab),
595 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START2_MODE0, 0xea),
596 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START3_MODE0, 0x02),
597 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CP_CTRL_MODE0, 0x06),
598 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_RCTRL_MODE0, 0x16),
599 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_CCTRL_MODE0, 0x36),
600 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
601 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN0_MODE0, 0x3f),
602 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE2_MODE0, 0x01),
603 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE1_MODE0, 0xc9),
604 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORECLK_DIV_MODE0, 0x0a),
605 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP3_MODE0, 0x00),
606 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE0, 0x34),
607 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE0, 0x15),
608 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_EN, 0x04),
609 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORE_CLK_EN, 0x00),
610 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_CFG, 0x00),
611 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_MAP, 0x00),
612 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_BUF_ENABLE, 0x0a),
613 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_EN_CENTER, 0x01),
614 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_PER1, 0x31),
615 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_PER2, 0x01),
616 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_ADJ_PER1, 0x00),
617 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_ADJ_PER2, 0x00),
618 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_STEP_SIZE1, 0x85),
619 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_STEP_SIZE2, 0x07),
620};
621
622static const struct qmp_phy_init_tbl qmp_v3_usb3_uniphy_tx_tbl[] = {
623 QMP_PHY_INIT_CFG(QSERDES_V3_TX_HIGHZ_DRVR_EN, 0x10),
624 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RCV_DETECT_LVL_2, 0x12),
625 QMP_PHY_INIT_CFG(QSERDES_V3_TX_LANE_MODE_1, 0xc6),
626 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX, 0x06),
627 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX, 0x06),
628};
629
630static const struct qmp_phy_init_tbl qmp_v3_usb3_uniphy_rx_tbl[] = {
631 QMP_PHY_INIT_CFG(QSERDES_V3_RX_VGA_CAL_CNTRL2, 0x0c),
632 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_MODE_00, 0x50),
633 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_FO_GAIN, 0x0b),
634 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL2, 0x0e),
635 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL3, 0x4e),
636 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL4, 0x18),
637 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x77),
638 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_OFFSET_ADAPTOR_CNTRL2, 0x80),
639 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_CNTRL, 0x03),
640 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_DEGLITCH_CNTRL, 0x1c),
641 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x75),
642};
643
644static const struct qmp_phy_init_tbl qmp_v3_usb3_uniphy_pcs_tbl[] = {
645
646 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNTRL2, 0x83),
647 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNT_VAL_L, 0x09),
648 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNT_VAL_H_TOL, 0xa2),
649 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_MAN_CODE, 0x40),
650 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNTRL1, 0x02),
651
652
653 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG1, 0xd1),
654 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG2, 0x1f),
655 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG3, 0x47),
656 QMP_PHY_INIT_CFG(QPHY_V3_PCS_POWER_STATE_CONFIG2, 0x1b),
657
658 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SIGDET_LVL, 0xba),
659 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V0, 0x9f),
660 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V1, 0x9f),
661 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V2, 0xb5),
662 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V3, 0x4c),
663 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V4, 0x64),
664 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_LS, 0x6a),
665 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V0, 0x15),
666 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V0, 0x0d),
667 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V1, 0x15),
668 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V1, 0x0d),
669 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V2, 0x15),
670 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V2, 0x0d),
671 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V3, 0x15),
672 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V3, 0x1d),
673 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V4, 0x15),
674 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V4, 0x0d),
675 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_LS, 0x15),
676 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_LS, 0x0d),
677
678 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RATE_SLEW_CNTRL, 0x02),
679 QMP_PHY_INIT_CFG(QPHY_V3_PCS_PWRUP_RESET_DLY_TIME_AUXCLK, 0x04),
680 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TSYNC_RSYNC_TIME, 0x44),
681 QMP_PHY_INIT_CFG(QPHY_V3_PCS_PWRUP_RESET_DLY_TIME_AUXCLK, 0x04),
682 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_P1U2_L, 0xe7),
683 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_P1U2_H, 0x03),
684 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_U3_L, 0x40),
685 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_U3_H, 0x00),
686 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RXEQTRAINING_WAIT_TIME, 0x75),
687 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LFPS_TX_ECSTART_EQTLOCK, 0x86),
688 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RXEQTRAINING_RUN_TIME, 0x13),
689
690 QMP_PHY_INIT_CFG(QPHY_V3_PCS_REFGEN_REQ_CONFIG1, 0x21),
691 QMP_PHY_INIT_CFG(QPHY_V3_PCS_REFGEN_REQ_CONFIG2, 0x60),
692};
693
694static const struct qmp_phy_init_tbl sdm845_ufsphy_serdes_tbl[] = {
695 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYS_CLK_CTRL, 0x02),
696 QMP_PHY_INIT_CFG(QSERDES_V3_COM_BIAS_EN_CLKBUFLR_EN, 0x04),
697 QMP_PHY_INIT_CFG(QSERDES_V3_COM_BG_TIMER, 0x0a),
698 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_IVCO, 0x07),
699 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CMN_CONFIG, 0x06),
700 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_EN_SEL, 0xd5),
701 QMP_PHY_INIT_CFG(QSERDES_V3_COM_RESETSM_CNTRL, 0x20),
702 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_SELECT, 0x30),
703 QMP_PHY_INIT_CFG(QSERDES_V3_COM_HSCLK_SEL, 0x00),
704 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_EN, 0x01),
705 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_CTRL, 0x00),
706 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORE_CLK_EN, 0x00),
707 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_MAP, 0x04),
708 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SVS_MODE_CLK_SEL, 0x05),
709 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_INITVAL1, 0xff),
710 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_INITVAL2, 0x00),
711 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE0, 0x82),
712 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CP_CTRL_MODE0, 0x06),
713 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_RCTRL_MODE0, 0x16),
714 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_CCTRL_MODE0, 0x36),
715 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN0_MODE0, 0x3f),
716 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
717 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE1_MODE0, 0xda),
718 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE2_MODE0, 0x01),
719 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE0, 0xff),
720 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE0, 0x0c),
721 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE1, 0x98),
722 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CP_CTRL_MODE1, 0x06),
723 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_RCTRL_MODE1, 0x16),
724 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_CCTRL_MODE1, 0x36),
725 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN0_MODE1, 0x3f),
726 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN1_MODE1, 0x00),
727 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE1_MODE1, 0xc1),
728 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE2_MODE1, 0x00),
729 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE1, 0x32),
730 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE1, 0x0f),
731
732
733 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_MAP, 0x44),
734};
735
736static const struct qmp_phy_init_tbl sdm845_ufsphy_tx_tbl[] = {
737 QMP_PHY_INIT_CFG(QSERDES_V3_TX_LANE_MODE_1, 0x06),
738 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX, 0x04),
739 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX, 0x07),
740};
741
742static const struct qmp_phy_init_tbl sdm845_ufsphy_rx_tbl[] = {
743 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_LVL, 0x24),
744 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_CNTRL, 0x0f),
745 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_DEGLITCH_CNTRL, 0x1e),
746 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_INTERFACE_MODE, 0x40),
747 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_FO_GAIN, 0x0b),
748 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_TERM_BW, 0x5b),
749 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL2, 0x06),
750 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL3, 0x04),
751 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL4, 0x1b),
752 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SVS_SO_GAIN_HALF, 0x04),
753 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SVS_SO_GAIN_QUARTER, 0x04),
754 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SVS_SO_GAIN, 0x04),
755 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x4b),
756 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_PI_CONTROLS, 0x81),
757 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_COUNT_LOW, 0x80),
758 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_MODE_00, 0x59),
759};
760
761static const struct qmp_phy_init_tbl sdm845_ufsphy_pcs_tbl[] = {
762 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SIGDET_CTRL2, 0x6e),
763 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TX_LARGE_AMP_DRV_LVL, 0x0a),
764 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TX_SMALL_AMP_DRV_LVL, 0x02),
765 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SYM_RESYNC_CTRL, 0x03),
766 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TX_MID_TERM_CTRL1, 0x43),
767 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SIGDET_CTRL1, 0x0f),
768 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_MIN_HIBERN8_TIME, 0x9a),
769 QMP_PHY_INIT_CFG(QPHY_V3_PCS_MULTI_LANE_CTRL1, 0x02),
770};
771
772static const struct qmp_phy_init_tbl msm8998_usb3_serdes_tbl[] = {
773 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_SELECT, 0x30),
774 QMP_PHY_INIT_CFG(QSERDES_V3_COM_BIAS_EN_CLKBUFLR_EN, 0x04),
775 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_EN_SEL, 0x14),
776 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYS_CLK_CTRL, 0x06),
777 QMP_PHY_INIT_CFG(QSERDES_V3_COM_RESETSM_CNTRL2, 0x08),
778 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CMN_CONFIG, 0x06),
779 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SVS_MODE_CLK_SEL, 0x01),
780 QMP_PHY_INIT_CFG(QSERDES_V3_COM_HSCLK_SEL, 0x80),
781 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE0, 0x82),
782 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START1_MODE0, 0xab),
783 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START2_MODE0, 0xea),
784 QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START3_MODE0, 0x02),
785 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CP_CTRL_MODE0, 0x06),
786 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_RCTRL_MODE0, 0x16),
787 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_CCTRL_MODE0, 0x36),
788 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
789 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN0_MODE0, 0x3f),
790 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE2_MODE0, 0x01),
791 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE1_MODE0, 0xc9),
792 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORECLK_DIV_MODE0, 0x0a),
793 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP3_MODE0, 0x00),
794 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE0, 0x34),
795 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE0, 0x15),
796 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_EN, 0x04),
797 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORE_CLK_EN, 0x00),
798 QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_CFG, 0x00),
799 QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_MAP, 0x00),
800 QMP_PHY_INIT_CFG(QSERDES_V3_COM_BG_TIMER, 0x0a),
801 QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_IVCO, 0x07),
802 QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_INITVAL, 0x80),
803 QMP_PHY_INIT_CFG(QSERDES_V3_COM_CMN_MODE, 0x01),
804 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_EN_CENTER, 0x01),
805 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_PER1, 0x31),
806 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_PER2, 0x01),
807 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_ADJ_PER1, 0x00),
808 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_ADJ_PER2, 0x00),
809 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_STEP_SIZE1, 0x85),
810 QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_STEP_SIZE2, 0x07),
811};
812
813static const struct qmp_phy_init_tbl msm8998_usb3_tx_tbl[] = {
814 QMP_PHY_INIT_CFG(QSERDES_V3_TX_HIGHZ_DRVR_EN, 0x10),
815 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RCV_DETECT_LVL_2, 0x12),
816 QMP_PHY_INIT_CFG(QSERDES_V3_TX_LANE_MODE_1, 0x16),
817 QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX, 0x00),
818};
819
820static const struct qmp_phy_init_tbl msm8998_usb3_rx_tbl[] = {
821 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_FO_GAIN, 0x0b),
822 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL2, 0x0f),
823 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL3, 0x4e),
824 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL4, 0x18),
825 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x07),
826 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_OFFSET_ADAPTOR_CNTRL2, 0x80),
827 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_CNTRL, 0x43),
828 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_DEGLITCH_CNTRL, 0x1c),
829 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x75),
830 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_COUNT_LOW, 0x00),
831 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_COUNT_HIGH, 0x00),
832 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_PI_CONTROLS, 0x80),
833 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FO_GAIN, 0x0a),
834 QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SO_GAIN, 0x06),
835 QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_ENABLES, 0x00),
836 QMP_PHY_INIT_CFG(QSERDES_V3_RX_VGA_CAL_CNTRL2, 0x03),
837 QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_MODE_00, 0x05),
838};
839
840static const struct qmp_phy_init_tbl msm8998_usb3_pcs_tbl[] = {
841 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNTRL2, 0x83),
842 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNT_VAL_L, 0x09),
843 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNT_VAL_H_TOL, 0xa2),
844 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_MAN_CODE, 0x40),
845 QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNTRL1, 0x02),
846 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG1, 0xd1),
847 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG2, 0x1f),
848 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG3, 0x47),
849 QMP_PHY_INIT_CFG(QPHY_V3_PCS_POWER_STATE_CONFIG2, 0x1b),
850 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V0, 0x9f),
851 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V1, 0x9f),
852 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V2, 0xb7),
853 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V3, 0x4e),
854 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V4, 0x65),
855 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_LS, 0x6b),
856 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V0, 0x15),
857 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V0, 0x0d),
858 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TX_LARGE_AMP_DRV_LVL, 0x15),
859 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V1, 0x0d),
860 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V2, 0x15),
861 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V2, 0x0d),
862 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V3, 0x15),
863 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V3, 0x0d),
864 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V4, 0x15),
865 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V4, 0x0d),
866 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_LS, 0x15),
867 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_LS, 0x0d),
868 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RATE_SLEW_CNTRL, 0x02),
869 QMP_PHY_INIT_CFG(QPHY_V3_PCS_PWRUP_RESET_DLY_TIME_AUXCLK, 0x04),
870 QMP_PHY_INIT_CFG(QPHY_V3_PCS_TSYNC_RSYNC_TIME, 0x44),
871 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_P1U2_L, 0xe7),
872 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_P1U2_H, 0x03),
873 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_U3_L, 0x40),
874 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_U3_H, 0x00),
875 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SIGDET_LVL, 0x8a),
876 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RXEQTRAINING_WAIT_TIME, 0x75),
877 QMP_PHY_INIT_CFG(QPHY_V3_PCS_LFPS_TX_ECSTART_EQTLOCK, 0x86),
878 QMP_PHY_INIT_CFG(QPHY_V3_PCS_RXEQTRAINING_RUN_TIME, 0x13),
879};
880
881
882
883struct qmp_phy_cfg {
884
885 unsigned int type;
886
887 int nlanes;
888
889
890 const struct qmp_phy_init_tbl *serdes_tbl;
891 int serdes_tbl_num;
892 const struct qmp_phy_init_tbl *tx_tbl;
893 int tx_tbl_num;
894 const struct qmp_phy_init_tbl *rx_tbl;
895 int rx_tbl_num;
896 const struct qmp_phy_init_tbl *pcs_tbl;
897 int pcs_tbl_num;
898
899
900 const char * const *clk_list;
901 int num_clks;
902
903 const char * const *reset_list;
904 int num_resets;
905
906 const char * const *vreg_list;
907 int num_vregs;
908
909
910 const unsigned int *regs;
911
912 unsigned int start_ctrl;
913 unsigned int pwrdn_ctrl;
914 unsigned int mask_pcs_ready;
915 unsigned int mask_com_pcs_ready;
916
917
918 bool has_phy_com_ctrl;
919
920 bool has_lane_rst;
921
922 bool has_pwrdn_delay;
923
924 int pwrdn_delay_min;
925 int pwrdn_delay_max;
926
927
928 bool has_phy_dp_com_ctrl;
929
930 bool is_dual_lane_phy;
931
932
933 bool no_pcs_sw_reset;
934};
935
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950
951struct qmp_phy {
952 struct phy *phy;
953 void __iomem *tx;
954 void __iomem *rx;
955 void __iomem *pcs;
956 void __iomem *tx2;
957 void __iomem *rx2;
958 void __iomem *pcs_misc;
959 struct clk *pipe_clk;
960 unsigned int index;
961 struct qcom_qmp *qmp;
962 struct reset_control *lane_rst;
963};
964
965
966
967
968
969
970
971
972
973
974
975
976
977
978
979
980
981
982
983
984struct qcom_qmp {
985 struct device *dev;
986 void __iomem *serdes;
987 void __iomem *dp_com;
988
989 struct clk_bulk_data *clks;
990 struct reset_control **resets;
991 struct regulator_bulk_data *vregs;
992
993 const struct qmp_phy_cfg *cfg;
994 struct qmp_phy **phys;
995
996 struct mutex phy_mutex;
997 int init_count;
998 bool phy_initialized;
999 enum phy_mode mode;
1000
1001 struct reset_control *ufs_reset;
1002};
1003
1004static inline void qphy_setbits(void __iomem *base, u32 offset, u32 val)
1005{
1006 u32 reg;
1007
1008 reg = readl(base + offset);
1009 reg |= val;
1010 writel(reg, base + offset);
1011
1012
1013 readl(base + offset);
1014}
1015
1016static inline void qphy_clrbits(void __iomem *base, u32 offset, u32 val)
1017{
1018 u32 reg;
1019
1020 reg = readl(base + offset);
1021 reg &= ~val;
1022 writel(reg, base + offset);
1023
1024
1025 readl(base + offset);
1026}
1027
1028
1029static const char * const msm8996_phy_clk_l[] = {
1030 "aux", "cfg_ahb", "ref",
1031};
1032
1033static const char * const qmp_v3_phy_clk_l[] = {
1034 "aux", "cfg_ahb", "ref", "com_aux",
1035};
1036
1037static const char * const sdm845_ufs_phy_clk_l[] = {
1038 "ref", "ref_aux",
1039};
1040
1041
1042static const char * const msm8996_pciephy_reset_l[] = {
1043 "phy", "common", "cfg",
1044};
1045
1046static const char * const msm8996_usb3phy_reset_l[] = {
1047 "phy", "common",
1048};
1049
1050
1051static const char * const qmp_phy_vreg_l[] = {
1052 "vdda-phy", "vdda-pll",
1053};
1054
1055static const struct qmp_phy_cfg msm8996_pciephy_cfg = {
1056 .type = PHY_TYPE_PCIE,
1057 .nlanes = 3,
1058
1059 .serdes_tbl = msm8996_pcie_serdes_tbl,
1060 .serdes_tbl_num = ARRAY_SIZE(msm8996_pcie_serdes_tbl),
1061 .tx_tbl = msm8996_pcie_tx_tbl,
1062 .tx_tbl_num = ARRAY_SIZE(msm8996_pcie_tx_tbl),
1063 .rx_tbl = msm8996_pcie_rx_tbl,
1064 .rx_tbl_num = ARRAY_SIZE(msm8996_pcie_rx_tbl),
1065 .pcs_tbl = msm8996_pcie_pcs_tbl,
1066 .pcs_tbl_num = ARRAY_SIZE(msm8996_pcie_pcs_tbl),
1067 .clk_list = msm8996_phy_clk_l,
1068 .num_clks = ARRAY_SIZE(msm8996_phy_clk_l),
1069 .reset_list = msm8996_pciephy_reset_l,
1070 .num_resets = ARRAY_SIZE(msm8996_pciephy_reset_l),
1071 .vreg_list = qmp_phy_vreg_l,
1072 .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l),
1073 .regs = pciephy_regs_layout,
1074
1075 .start_ctrl = PCS_START | PLL_READY_GATE_EN,
1076 .pwrdn_ctrl = SW_PWRDN | REFCLK_DRV_DSBL,
1077 .mask_com_pcs_ready = PCS_READY,
1078
1079 .has_phy_com_ctrl = true,
1080 .has_lane_rst = true,
1081 .has_pwrdn_delay = true,
1082 .pwrdn_delay_min = POWER_DOWN_DELAY_US_MIN,
1083 .pwrdn_delay_max = POWER_DOWN_DELAY_US_MAX,
1084};
1085
1086static const struct qmp_phy_cfg msm8996_usb3phy_cfg = {
1087 .type = PHY_TYPE_USB3,
1088 .nlanes = 1,
1089
1090 .serdes_tbl = msm8996_usb3_serdes_tbl,
1091 .serdes_tbl_num = ARRAY_SIZE(msm8996_usb3_serdes_tbl),
1092 .tx_tbl = msm8996_usb3_tx_tbl,
1093 .tx_tbl_num = ARRAY_SIZE(msm8996_usb3_tx_tbl),
1094 .rx_tbl = msm8996_usb3_rx_tbl,
1095 .rx_tbl_num = ARRAY_SIZE(msm8996_usb3_rx_tbl),
1096 .pcs_tbl = msm8996_usb3_pcs_tbl,
1097 .pcs_tbl_num = ARRAY_SIZE(msm8996_usb3_pcs_tbl),
1098 .clk_list = msm8996_phy_clk_l,
1099 .num_clks = ARRAY_SIZE(msm8996_phy_clk_l),
1100 .reset_list = msm8996_usb3phy_reset_l,
1101 .num_resets = ARRAY_SIZE(msm8996_usb3phy_reset_l),
1102 .vreg_list = qmp_phy_vreg_l,
1103 .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l),
1104 .regs = usb3phy_regs_layout,
1105
1106 .start_ctrl = SERDES_START | PCS_START,
1107 .pwrdn_ctrl = SW_PWRDN,
1108 .mask_pcs_ready = PHYSTATUS,
1109};
1110
1111
1112static const char * const ipq8074_pciephy_reset_l[] = {
1113 "phy", "common",
1114};
1115
1116static const struct qmp_phy_cfg ipq8074_pciephy_cfg = {
1117 .type = PHY_TYPE_PCIE,
1118 .nlanes = 1,
1119
1120 .serdes_tbl = ipq8074_pcie_serdes_tbl,
1121 .serdes_tbl_num = ARRAY_SIZE(ipq8074_pcie_serdes_tbl),
1122 .tx_tbl = ipq8074_pcie_tx_tbl,
1123 .tx_tbl_num = ARRAY_SIZE(ipq8074_pcie_tx_tbl),
1124 .rx_tbl = ipq8074_pcie_rx_tbl,
1125 .rx_tbl_num = ARRAY_SIZE(ipq8074_pcie_rx_tbl),
1126 .pcs_tbl = ipq8074_pcie_pcs_tbl,
1127 .pcs_tbl_num = ARRAY_SIZE(ipq8074_pcie_pcs_tbl),
1128 .clk_list = NULL,
1129 .num_clks = 0,
1130 .reset_list = ipq8074_pciephy_reset_l,
1131 .num_resets = ARRAY_SIZE(ipq8074_pciephy_reset_l),
1132 .vreg_list = NULL,
1133 .num_vregs = 0,
1134 .regs = pciephy_regs_layout,
1135
1136 .start_ctrl = SERDES_START | PCS_START,
1137 .pwrdn_ctrl = SW_PWRDN | REFCLK_DRV_DSBL,
1138 .mask_pcs_ready = PHYSTATUS,
1139
1140 .has_phy_com_ctrl = false,
1141 .has_lane_rst = false,
1142 .has_pwrdn_delay = true,
1143 .pwrdn_delay_min = 995,
1144 .pwrdn_delay_max = 1005,
1145};
1146
1147static const struct qmp_phy_cfg qmp_v3_usb3phy_cfg = {
1148 .type = PHY_TYPE_USB3,
1149 .nlanes = 1,
1150
1151 .serdes_tbl = qmp_v3_usb3_serdes_tbl,
1152 .serdes_tbl_num = ARRAY_SIZE(qmp_v3_usb3_serdes_tbl),
1153 .tx_tbl = qmp_v3_usb3_tx_tbl,
1154 .tx_tbl_num = ARRAY_SIZE(qmp_v3_usb3_tx_tbl),
1155 .rx_tbl = qmp_v3_usb3_rx_tbl,
1156 .rx_tbl_num = ARRAY_SIZE(qmp_v3_usb3_rx_tbl),
1157 .pcs_tbl = qmp_v3_usb3_pcs_tbl,
1158 .pcs_tbl_num = ARRAY_SIZE(qmp_v3_usb3_pcs_tbl),
1159 .clk_list = qmp_v3_phy_clk_l,
1160 .num_clks = ARRAY_SIZE(qmp_v3_phy_clk_l),
1161 .reset_list = msm8996_usb3phy_reset_l,
1162 .num_resets = ARRAY_SIZE(msm8996_usb3phy_reset_l),
1163 .vreg_list = qmp_phy_vreg_l,
1164 .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l),
1165 .regs = qmp_v3_usb3phy_regs_layout,
1166
1167 .start_ctrl = SERDES_START | PCS_START,
1168 .pwrdn_ctrl = SW_PWRDN,
1169 .mask_pcs_ready = PHYSTATUS,
1170
1171 .has_pwrdn_delay = true,
1172 .pwrdn_delay_min = POWER_DOWN_DELAY_US_MIN,
1173 .pwrdn_delay_max = POWER_DOWN_DELAY_US_MAX,
1174
1175 .has_phy_dp_com_ctrl = true,
1176 .is_dual_lane_phy = true,
1177};
1178
1179static const struct qmp_phy_cfg qmp_v3_usb3_uniphy_cfg = {
1180 .type = PHY_TYPE_USB3,
1181 .nlanes = 1,
1182
1183 .serdes_tbl = qmp_v3_usb3_uniphy_serdes_tbl,
1184 .serdes_tbl_num = ARRAY_SIZE(qmp_v3_usb3_uniphy_serdes_tbl),
1185 .tx_tbl = qmp_v3_usb3_uniphy_tx_tbl,
1186 .tx_tbl_num = ARRAY_SIZE(qmp_v3_usb3_uniphy_tx_tbl),
1187 .rx_tbl = qmp_v3_usb3_uniphy_rx_tbl,
1188 .rx_tbl_num = ARRAY_SIZE(qmp_v3_usb3_uniphy_rx_tbl),
1189 .pcs_tbl = qmp_v3_usb3_uniphy_pcs_tbl,
1190 .pcs_tbl_num = ARRAY_SIZE(qmp_v3_usb3_uniphy_pcs_tbl),
1191 .clk_list = qmp_v3_phy_clk_l,
1192 .num_clks = ARRAY_SIZE(qmp_v3_phy_clk_l),
1193 .reset_list = msm8996_usb3phy_reset_l,
1194 .num_resets = ARRAY_SIZE(msm8996_usb3phy_reset_l),
1195 .vreg_list = qmp_phy_vreg_l,
1196 .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l),
1197 .regs = qmp_v3_usb3phy_regs_layout,
1198
1199 .start_ctrl = SERDES_START | PCS_START,
1200 .pwrdn_ctrl = SW_PWRDN,
1201 .mask_pcs_ready = PHYSTATUS,
1202
1203 .has_pwrdn_delay = true,
1204 .pwrdn_delay_min = POWER_DOWN_DELAY_US_MIN,
1205 .pwrdn_delay_max = POWER_DOWN_DELAY_US_MAX,
1206};
1207
1208static const struct qmp_phy_cfg sdm845_ufsphy_cfg = {
1209 .type = PHY_TYPE_UFS,
1210 .nlanes = 2,
1211
1212 .serdes_tbl = sdm845_ufsphy_serdes_tbl,
1213 .serdes_tbl_num = ARRAY_SIZE(sdm845_ufsphy_serdes_tbl),
1214 .tx_tbl = sdm845_ufsphy_tx_tbl,
1215 .tx_tbl_num = ARRAY_SIZE(sdm845_ufsphy_tx_tbl),
1216 .rx_tbl = sdm845_ufsphy_rx_tbl,
1217 .rx_tbl_num = ARRAY_SIZE(sdm845_ufsphy_rx_tbl),
1218 .pcs_tbl = sdm845_ufsphy_pcs_tbl,
1219 .pcs_tbl_num = ARRAY_SIZE(sdm845_ufsphy_pcs_tbl),
1220 .clk_list = sdm845_ufs_phy_clk_l,
1221 .num_clks = ARRAY_SIZE(sdm845_ufs_phy_clk_l),
1222 .vreg_list = qmp_phy_vreg_l,
1223 .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l),
1224 .regs = sdm845_ufsphy_regs_layout,
1225
1226 .start_ctrl = SERDES_START,
1227 .pwrdn_ctrl = SW_PWRDN,
1228 .mask_pcs_ready = PCS_READY,
1229
1230 .is_dual_lane_phy = true,
1231 .no_pcs_sw_reset = true,
1232};
1233
1234static const struct qmp_phy_cfg msm8998_pciephy_cfg = {
1235 .type = PHY_TYPE_PCIE,
1236 .nlanes = 1,
1237
1238 .serdes_tbl = msm8998_pcie_serdes_tbl,
1239 .serdes_tbl_num = ARRAY_SIZE(msm8998_pcie_serdes_tbl),
1240 .tx_tbl = msm8998_pcie_tx_tbl,
1241 .tx_tbl_num = ARRAY_SIZE(msm8998_pcie_tx_tbl),
1242 .rx_tbl = msm8998_pcie_rx_tbl,
1243 .rx_tbl_num = ARRAY_SIZE(msm8998_pcie_rx_tbl),
1244 .pcs_tbl = msm8998_pcie_pcs_tbl,
1245 .pcs_tbl_num = ARRAY_SIZE(msm8998_pcie_pcs_tbl),
1246 .clk_list = msm8996_phy_clk_l,
1247 .num_clks = ARRAY_SIZE(msm8996_phy_clk_l),
1248 .reset_list = ipq8074_pciephy_reset_l,
1249 .num_resets = ARRAY_SIZE(ipq8074_pciephy_reset_l),
1250 .vreg_list = qmp_phy_vreg_l,
1251 .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l),
1252 .regs = pciephy_regs_layout,
1253
1254 .start_ctrl = SERDES_START | PCS_START,
1255 .pwrdn_ctrl = SW_PWRDN | REFCLK_DRV_DSBL,
1256 .mask_com_pcs_ready = PCS_READY,
1257};
1258
1259static const struct qmp_phy_cfg msm8998_usb3phy_cfg = {
1260 .type = PHY_TYPE_USB3,
1261 .nlanes = 1,
1262
1263 .serdes_tbl = msm8998_usb3_serdes_tbl,
1264 .serdes_tbl_num = ARRAY_SIZE(msm8998_usb3_serdes_tbl),
1265 .tx_tbl = msm8998_usb3_tx_tbl,
1266 .tx_tbl_num = ARRAY_SIZE(msm8998_usb3_tx_tbl),
1267 .rx_tbl = msm8998_usb3_rx_tbl,
1268 .rx_tbl_num = ARRAY_SIZE(msm8998_usb3_rx_tbl),
1269 .pcs_tbl = msm8998_usb3_pcs_tbl,
1270 .pcs_tbl_num = ARRAY_SIZE(msm8998_usb3_pcs_tbl),
1271 .clk_list = msm8996_phy_clk_l,
1272 .num_clks = ARRAY_SIZE(msm8996_phy_clk_l),
1273 .reset_list = msm8996_usb3phy_reset_l,
1274 .num_resets = ARRAY_SIZE(msm8996_usb3phy_reset_l),
1275 .vreg_list = qmp_phy_vreg_l,
1276 .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l),
1277 .regs = qmp_v3_usb3phy_regs_layout,
1278
1279 .start_ctrl = SERDES_START | PCS_START,
1280 .pwrdn_ctrl = SW_PWRDN,
1281 .mask_pcs_ready = PHYSTATUS,
1282
1283 .is_dual_lane_phy = true,
1284};
1285
1286static void qcom_qmp_phy_configure(void __iomem *base,
1287 const unsigned int *regs,
1288 const struct qmp_phy_init_tbl tbl[],
1289 int num)
1290{
1291 int i;
1292 const struct qmp_phy_init_tbl *t = tbl;
1293
1294 if (!t)
1295 return;
1296
1297 for (i = 0; i < num; i++, t++) {
1298 if (t->in_layout)
1299 writel(t->val, base + regs[t->offset]);
1300 else
1301 writel(t->val, base + t->offset);
1302 }
1303}
1304
1305static int qcom_qmp_phy_com_init(struct qmp_phy *qphy)
1306{
1307 struct qcom_qmp *qmp = qphy->qmp;
1308 const struct qmp_phy_cfg *cfg = qmp->cfg;
1309 void __iomem *serdes = qmp->serdes;
1310 void __iomem *pcs = qphy->pcs;
1311 void __iomem *dp_com = qmp->dp_com;
1312 int ret, i;
1313
1314 mutex_lock(&qmp->phy_mutex);
1315 if (qmp->init_count++) {
1316 mutex_unlock(&qmp->phy_mutex);
1317 return 0;
1318 }
1319
1320
1321 ret = regulator_bulk_enable(cfg->num_vregs, qmp->vregs);
1322 if (ret) {
1323 dev_err(qmp->dev, "failed to enable regulators, err=%d\n", ret);
1324 goto err_reg_enable;
1325 }
1326
1327 for (i = 0; i < cfg->num_resets; i++) {
1328 ret = reset_control_assert(qmp->resets[i]);
1329 if (ret) {
1330 dev_err(qmp->dev, "%s reset assert failed\n",
1331 cfg->reset_list[i]);
1332 goto err_rst_assert;
1333 }
1334 }
1335
1336 for (i = cfg->num_resets - 1; i >= 0; i--) {
1337 ret = reset_control_deassert(qmp->resets[i]);
1338 if (ret) {
1339 dev_err(qmp->dev, "%s reset deassert failed\n",
1340 qmp->cfg->reset_list[i]);
1341 goto err_rst;
1342 }
1343 }
1344
1345 ret = clk_bulk_prepare_enable(cfg->num_clks, qmp->clks);
1346 if (ret) {
1347 dev_err(qmp->dev, "failed to enable clks, err=%d\n", ret);
1348 goto err_rst;
1349 }
1350
1351 if (cfg->has_phy_dp_com_ctrl) {
1352 qphy_setbits(dp_com, QPHY_V3_DP_COM_POWER_DOWN_CTRL,
1353 SW_PWRDN);
1354
1355 qphy_setbits(dp_com, QPHY_V3_DP_COM_RESET_OVRD_CTRL,
1356 SW_DPPHY_RESET_MUX | SW_DPPHY_RESET |
1357 SW_USB3PHY_RESET_MUX | SW_USB3PHY_RESET);
1358
1359 qphy_setbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL,
1360 USB3_MODE | DP_MODE);
1361
1362
1363 qphy_clrbits(dp_com, QPHY_V3_DP_COM_RESET_OVRD_CTRL,
1364 SW_DPPHY_RESET_MUX | SW_DPPHY_RESET |
1365 SW_USB3PHY_RESET_MUX | SW_USB3PHY_RESET);
1366 }
1367
1368 if (cfg->has_phy_com_ctrl)
1369 qphy_setbits(serdes, cfg->regs[QPHY_COM_POWER_DOWN_CONTROL],
1370 SW_PWRDN);
1371 else
1372 qphy_setbits(pcs, QPHY_POWER_DOWN_CONTROL, cfg->pwrdn_ctrl);
1373
1374
1375 qcom_qmp_phy_configure(serdes, cfg->regs, cfg->serdes_tbl,
1376 cfg->serdes_tbl_num);
1377
1378 if (cfg->has_phy_com_ctrl) {
1379 void __iomem *status;
1380 unsigned int mask, val;
1381
1382 qphy_clrbits(serdes, cfg->regs[QPHY_COM_SW_RESET], SW_RESET);
1383 qphy_setbits(serdes, cfg->regs[QPHY_COM_START_CONTROL],
1384 SERDES_START | PCS_START);
1385
1386 status = serdes + cfg->regs[QPHY_COM_PCS_READY_STATUS];
1387 mask = cfg->mask_com_pcs_ready;
1388
1389 ret = readl_poll_timeout(status, val, (val & mask), 10,
1390 PHY_INIT_COMPLETE_TIMEOUT);
1391 if (ret) {
1392 dev_err(qmp->dev,
1393 "phy common block init timed-out\n");
1394 goto err_com_init;
1395 }
1396 }
1397
1398 mutex_unlock(&qmp->phy_mutex);
1399
1400 return 0;
1401
1402err_com_init:
1403 clk_bulk_disable_unprepare(cfg->num_clks, qmp->clks);
1404err_rst:
1405 while (++i < cfg->num_resets)
1406 reset_control_assert(qmp->resets[i]);
1407err_rst_assert:
1408 regulator_bulk_disable(cfg->num_vregs, qmp->vregs);
1409err_reg_enable:
1410 mutex_unlock(&qmp->phy_mutex);
1411
1412 return ret;
1413}
1414
1415static int qcom_qmp_phy_com_exit(struct qcom_qmp *qmp)
1416{
1417 const struct qmp_phy_cfg *cfg = qmp->cfg;
1418 void __iomem *serdes = qmp->serdes;
1419 int i = cfg->num_resets;
1420
1421 mutex_lock(&qmp->phy_mutex);
1422 if (--qmp->init_count) {
1423 mutex_unlock(&qmp->phy_mutex);
1424 return 0;
1425 }
1426
1427 reset_control_assert(qmp->ufs_reset);
1428 if (cfg->has_phy_com_ctrl) {
1429 qphy_setbits(serdes, cfg->regs[QPHY_COM_START_CONTROL],
1430 SERDES_START | PCS_START);
1431 qphy_clrbits(serdes, cfg->regs[QPHY_COM_SW_RESET],
1432 SW_RESET);
1433 qphy_setbits(serdes, cfg->regs[QPHY_COM_POWER_DOWN_CONTROL],
1434 SW_PWRDN);
1435 }
1436
1437 while (--i >= 0)
1438 reset_control_assert(qmp->resets[i]);
1439
1440 clk_bulk_disable_unprepare(cfg->num_clks, qmp->clks);
1441
1442 regulator_bulk_disable(cfg->num_vregs, qmp->vregs);
1443
1444 mutex_unlock(&qmp->phy_mutex);
1445
1446 return 0;
1447}
1448
1449static int qcom_qmp_phy_enable(struct phy *phy)
1450{
1451 struct qmp_phy *qphy = phy_get_drvdata(phy);
1452 struct qcom_qmp *qmp = qphy->qmp;
1453 const struct qmp_phy_cfg *cfg = qmp->cfg;
1454 void __iomem *tx = qphy->tx;
1455 void __iomem *rx = qphy->rx;
1456 void __iomem *pcs = qphy->pcs;
1457 void __iomem *dp_com = qmp->dp_com;
1458 void __iomem *status;
1459 unsigned int mask, val;
1460 int ret;
1461
1462 dev_vdbg(qmp->dev, "Initializing QMP phy\n");
1463
1464 if (cfg->no_pcs_sw_reset) {
1465
1466
1467
1468
1469
1470 if (!qmp->ufs_reset) {
1471 qmp->ufs_reset =
1472 devm_reset_control_get_exclusive(qmp->dev,
1473 "ufsphy");
1474
1475 if (IS_ERR(qmp->ufs_reset)) {
1476 ret = PTR_ERR(qmp->ufs_reset);
1477 dev_err(qmp->dev,
1478 "failed to get UFS reset: %d\n",
1479 ret);
1480
1481 qmp->ufs_reset = NULL;
1482 return ret;
1483 }
1484 }
1485
1486 ret = reset_control_assert(qmp->ufs_reset);
1487 if (ret)
1488 goto err_lane_rst;
1489 }
1490
1491 ret = qcom_qmp_phy_com_init(qphy);
1492 if (ret)
1493 return ret;
1494
1495 if (cfg->has_lane_rst) {
1496 ret = reset_control_deassert(qphy->lane_rst);
1497 if (ret) {
1498 dev_err(qmp->dev, "lane%d reset deassert failed\n",
1499 qphy->index);
1500 goto err_lane_rst;
1501 }
1502 }
1503
1504 ret = clk_prepare_enable(qphy->pipe_clk);
1505 if (ret) {
1506 dev_err(qmp->dev, "pipe_clk enable failed err=%d\n", ret);
1507 goto err_clk_enable;
1508 }
1509
1510
1511 qcom_qmp_phy_configure(tx, cfg->regs, cfg->tx_tbl, cfg->tx_tbl_num);
1512
1513 if (cfg->is_dual_lane_phy)
1514 qcom_qmp_phy_configure(qphy->tx2, cfg->regs,
1515 cfg->tx_tbl, cfg->tx_tbl_num);
1516
1517 qcom_qmp_phy_configure(rx, cfg->regs, cfg->rx_tbl, cfg->rx_tbl_num);
1518 if (cfg->is_dual_lane_phy)
1519 qcom_qmp_phy_configure(qphy->rx2, cfg->regs,
1520 cfg->rx_tbl, cfg->rx_tbl_num);
1521
1522 qcom_qmp_phy_configure(pcs, cfg->regs, cfg->pcs_tbl, cfg->pcs_tbl_num);
1523 ret = reset_control_deassert(qmp->ufs_reset);
1524 if (ret)
1525 goto err_lane_rst;
1526
1527
1528
1529
1530
1531 if(cfg->type == PHY_TYPE_PCIE)
1532 qphy_setbits(pcs, QPHY_POWER_DOWN_CONTROL, cfg->pwrdn_ctrl);
1533
1534 if (cfg->has_pwrdn_delay)
1535 usleep_range(cfg->pwrdn_delay_min, cfg->pwrdn_delay_max);
1536
1537
1538 if (!cfg->no_pcs_sw_reset)
1539 qphy_clrbits(pcs, cfg->regs[QPHY_SW_RESET], SW_RESET);
1540
1541 if (cfg->has_phy_dp_com_ctrl)
1542 qphy_clrbits(dp_com, QPHY_V3_DP_COM_SW_RESET, SW_RESET);
1543
1544
1545 qphy_setbits(pcs, cfg->regs[QPHY_START_CTRL], cfg->start_ctrl);
1546
1547 status = pcs + cfg->regs[QPHY_PCS_READY_STATUS];
1548 mask = cfg->mask_pcs_ready;
1549
1550 ret = readl_poll_timeout(status, val, !(val & mask), 1,
1551 PHY_INIT_COMPLETE_TIMEOUT);
1552 if (ret) {
1553 dev_err(qmp->dev, "phy initialization timed-out\n");
1554 goto err_pcs_ready;
1555 }
1556 qmp->phy_initialized = true;
1557 return 0;
1558
1559err_pcs_ready:
1560 reset_control_assert(qmp->ufs_reset);
1561 clk_disable_unprepare(qphy->pipe_clk);
1562err_clk_enable:
1563 if (cfg->has_lane_rst)
1564 reset_control_assert(qphy->lane_rst);
1565err_lane_rst:
1566 qcom_qmp_phy_com_exit(qmp);
1567
1568 return ret;
1569}
1570
1571static int qcom_qmp_phy_disable(struct phy *phy)
1572{
1573 struct qmp_phy *qphy = phy_get_drvdata(phy);
1574 struct qcom_qmp *qmp = qphy->qmp;
1575 const struct qmp_phy_cfg *cfg = qmp->cfg;
1576
1577 clk_disable_unprepare(qphy->pipe_clk);
1578
1579
1580 if (!cfg->no_pcs_sw_reset)
1581 qphy_setbits(qphy->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET);
1582
1583
1584 qphy_clrbits(qphy->pcs, cfg->regs[QPHY_START_CTRL], cfg->start_ctrl);
1585
1586
1587 qphy_clrbits(qphy->pcs, QPHY_POWER_DOWN_CONTROL, cfg->pwrdn_ctrl);
1588
1589 if (cfg->has_lane_rst)
1590 reset_control_assert(qphy->lane_rst);
1591
1592 qcom_qmp_phy_com_exit(qmp);
1593
1594 qmp->phy_initialized = false;
1595
1596 return 0;
1597}
1598
1599static int qcom_qmp_phy_set_mode(struct phy *phy,
1600 enum phy_mode mode, int submode)
1601{
1602 struct qmp_phy *qphy = phy_get_drvdata(phy);
1603 struct qcom_qmp *qmp = qphy->qmp;
1604
1605 qmp->mode = mode;
1606
1607 return 0;
1608}
1609
1610static void qcom_qmp_phy_enable_autonomous_mode(struct qmp_phy *qphy)
1611{
1612 struct qcom_qmp *qmp = qphy->qmp;
1613 const struct qmp_phy_cfg *cfg = qmp->cfg;
1614 void __iomem *pcs = qphy->pcs;
1615 void __iomem *pcs_misc = qphy->pcs_misc;
1616 u32 intr_mask;
1617
1618 if (qmp->mode == PHY_MODE_USB_HOST_SS ||
1619 qmp->mode == PHY_MODE_USB_DEVICE_SS)
1620 intr_mask = ARCVR_DTCT_EN | ALFPS_DTCT_EN;
1621 else
1622 intr_mask = ARCVR_DTCT_EN | ARCVR_DTCT_EVENT_SEL;
1623
1624
1625 qphy_setbits(pcs, cfg->regs[QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR], IRQ_CLEAR);
1626
1627 qphy_clrbits(pcs, cfg->regs[QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR], IRQ_CLEAR);
1628
1629 qphy_clrbits(pcs, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL],
1630 ARCVR_DTCT_EN | ALFPS_DTCT_EN | ARCVR_DTCT_EVENT_SEL);
1631
1632
1633 qphy_setbits(pcs, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL], intr_mask);
1634
1635
1636 if (pcs_misc)
1637 qphy_clrbits(pcs_misc, QPHY_V3_PCS_MISC_CLAMP_ENABLE, CLAMP_EN);
1638}
1639
1640static void qcom_qmp_phy_disable_autonomous_mode(struct qmp_phy *qphy)
1641{
1642 struct qcom_qmp *qmp = qphy->qmp;
1643 const struct qmp_phy_cfg *cfg = qmp->cfg;
1644 void __iomem *pcs = qphy->pcs;
1645 void __iomem *pcs_misc = qphy->pcs_misc;
1646
1647
1648 if (pcs_misc)
1649 qphy_setbits(pcs_misc, QPHY_V3_PCS_MISC_CLAMP_ENABLE, CLAMP_EN);
1650
1651 qphy_clrbits(pcs, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL],
1652 ARCVR_DTCT_EN | ARCVR_DTCT_EVENT_SEL | ALFPS_DTCT_EN);
1653
1654 qphy_setbits(pcs, cfg->regs[QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR], IRQ_CLEAR);
1655
1656 qphy_clrbits(pcs, cfg->regs[QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR], IRQ_CLEAR);
1657}
1658
1659static int __maybe_unused qcom_qmp_phy_runtime_suspend(struct device *dev)
1660{
1661 struct qcom_qmp *qmp = dev_get_drvdata(dev);
1662 struct qmp_phy *qphy = qmp->phys[0];
1663 const struct qmp_phy_cfg *cfg = qmp->cfg;
1664
1665 dev_vdbg(dev, "Suspending QMP phy, mode:%d\n", qmp->mode);
1666
1667
1668 if (cfg->type != PHY_TYPE_USB3)
1669 return 0;
1670
1671 if (!qmp->phy_initialized) {
1672 dev_vdbg(dev, "PHY not initialized, bailing out\n");
1673 return 0;
1674 }
1675
1676 qcom_qmp_phy_enable_autonomous_mode(qphy);
1677
1678 clk_disable_unprepare(qphy->pipe_clk);
1679 clk_bulk_disable_unprepare(cfg->num_clks, qmp->clks);
1680
1681 return 0;
1682}
1683
1684static int __maybe_unused qcom_qmp_phy_runtime_resume(struct device *dev)
1685{
1686 struct qcom_qmp *qmp = dev_get_drvdata(dev);
1687 struct qmp_phy *qphy = qmp->phys[0];
1688 const struct qmp_phy_cfg *cfg = qmp->cfg;
1689 int ret = 0;
1690
1691 dev_vdbg(dev, "Resuming QMP phy, mode:%d\n", qmp->mode);
1692
1693
1694 if (cfg->type != PHY_TYPE_USB3)
1695 return 0;
1696
1697 if (!qmp->phy_initialized) {
1698 dev_vdbg(dev, "PHY not initialized, bailing out\n");
1699 return 0;
1700 }
1701
1702 ret = clk_bulk_prepare_enable(cfg->num_clks, qmp->clks);
1703 if (ret) {
1704 dev_err(qmp->dev, "failed to enable clks, err=%d\n", ret);
1705 return ret;
1706 }
1707
1708 ret = clk_prepare_enable(qphy->pipe_clk);
1709 if (ret) {
1710 dev_err(dev, "pipe_clk enable failed, err=%d\n", ret);
1711 clk_bulk_disable_unprepare(cfg->num_clks, qmp->clks);
1712 return ret;
1713 }
1714
1715 qcom_qmp_phy_disable_autonomous_mode(qphy);
1716
1717 return 0;
1718}
1719
1720static int qcom_qmp_phy_vreg_init(struct device *dev)
1721{
1722 struct qcom_qmp *qmp = dev_get_drvdata(dev);
1723 int num = qmp->cfg->num_vregs;
1724 int i;
1725
1726 qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL);
1727 if (!qmp->vregs)
1728 return -ENOMEM;
1729
1730 for (i = 0; i < num; i++)
1731 qmp->vregs[i].supply = qmp->cfg->vreg_list[i];
1732
1733 return devm_regulator_bulk_get(dev, num, qmp->vregs);
1734}
1735
1736static int qcom_qmp_phy_reset_init(struct device *dev)
1737{
1738 struct qcom_qmp *qmp = dev_get_drvdata(dev);
1739 int i;
1740
1741 qmp->resets = devm_kcalloc(dev, qmp->cfg->num_resets,
1742 sizeof(*qmp->resets), GFP_KERNEL);
1743 if (!qmp->resets)
1744 return -ENOMEM;
1745
1746 for (i = 0; i < qmp->cfg->num_resets; i++) {
1747 struct reset_control *rst;
1748 const char *name = qmp->cfg->reset_list[i];
1749
1750 rst = devm_reset_control_get(dev, name);
1751 if (IS_ERR(rst)) {
1752 dev_err(dev, "failed to get %s reset\n", name);
1753 return PTR_ERR(rst);
1754 }
1755 qmp->resets[i] = rst;
1756 }
1757
1758 return 0;
1759}
1760
1761static int qcom_qmp_phy_clk_init(struct device *dev)
1762{
1763 struct qcom_qmp *qmp = dev_get_drvdata(dev);
1764 int num = qmp->cfg->num_clks;
1765 int i;
1766
1767 qmp->clks = devm_kcalloc(dev, num, sizeof(*qmp->clks), GFP_KERNEL);
1768 if (!qmp->clks)
1769 return -ENOMEM;
1770
1771 for (i = 0; i < num; i++)
1772 qmp->clks[i].id = qmp->cfg->clk_list[i];
1773
1774 return devm_clk_bulk_get(dev, num, qmp->clks);
1775}
1776
1777static void phy_pipe_clk_release_provider(void *res)
1778{
1779 of_clk_del_provider(res);
1780}
1781
1782
1783
1784
1785
1786
1787
1788
1789
1790
1791
1792
1793
1794
1795
1796
1797
1798
1799
1800static int phy_pipe_clk_register(struct qcom_qmp *qmp, struct device_node *np)
1801{
1802 struct clk_fixed_rate *fixed;
1803 struct clk_init_data init = { };
1804 int ret;
1805
1806 if ((qmp->cfg->type != PHY_TYPE_USB3) &&
1807 (qmp->cfg->type != PHY_TYPE_PCIE)) {
1808
1809 return 0;
1810 }
1811
1812 ret = of_property_read_string(np, "clock-output-names", &init.name);
1813 if (ret) {
1814 dev_err(qmp->dev, "%pOFn: No clock-output-names\n", np);
1815 return ret;
1816 }
1817
1818 fixed = devm_kzalloc(qmp->dev, sizeof(*fixed), GFP_KERNEL);
1819 if (!fixed)
1820 return -ENOMEM;
1821
1822 init.ops = &clk_fixed_rate_ops;
1823
1824
1825 fixed->fixed_rate = 125000000;
1826 fixed->hw.init = &init;
1827
1828 ret = devm_clk_hw_register(qmp->dev, &fixed->hw);
1829 if (ret)
1830 return ret;
1831
1832 ret = of_clk_add_hw_provider(np, of_clk_hw_simple_get, &fixed->hw);
1833 if (ret)
1834 return ret;
1835
1836
1837
1838
1839
1840 ret = devm_add_action(qmp->dev, phy_pipe_clk_release_provider, np);
1841 if (ret)
1842 phy_pipe_clk_release_provider(np);
1843
1844 return ret;
1845}
1846
1847static const struct phy_ops qcom_qmp_phy_gen_ops = {
1848 .init = qcom_qmp_phy_enable,
1849 .exit = qcom_qmp_phy_disable,
1850 .set_mode = qcom_qmp_phy_set_mode,
1851 .owner = THIS_MODULE,
1852};
1853
1854static const struct phy_ops qcom_qmp_ufs_ops = {
1855 .power_on = qcom_qmp_phy_enable,
1856 .power_off = qcom_qmp_phy_disable,
1857 .set_mode = qcom_qmp_phy_set_mode,
1858 .owner = THIS_MODULE,
1859};
1860
1861static
1862int qcom_qmp_phy_create(struct device *dev, struct device_node *np, int id)
1863{
1864 struct qcom_qmp *qmp = dev_get_drvdata(dev);
1865 struct phy *generic_phy;
1866 struct qmp_phy *qphy;
1867 const struct phy_ops *ops = &qcom_qmp_phy_gen_ops;
1868 char prop_name[MAX_PROP_NAME];
1869 int ret;
1870
1871 qphy = devm_kzalloc(dev, sizeof(*qphy), GFP_KERNEL);
1872 if (!qphy)
1873 return -ENOMEM;
1874
1875
1876
1877
1878
1879
1880
1881 qphy->tx = of_iomap(np, 0);
1882 if (!qphy->tx)
1883 return -ENOMEM;
1884
1885 qphy->rx = of_iomap(np, 1);
1886 if (!qphy->rx)
1887 return -ENOMEM;
1888
1889 qphy->pcs = of_iomap(np, 2);
1890 if (!qphy->pcs)
1891 return -ENOMEM;
1892
1893
1894
1895
1896
1897
1898
1899 if (qmp->cfg->is_dual_lane_phy) {
1900 qphy->tx2 = of_iomap(np, 3);
1901 qphy->rx2 = of_iomap(np, 4);
1902 if (!qphy->tx2 || !qphy->rx2) {
1903 dev_warn(dev,
1904 "Underspecified device tree, falling back to legacy register regions\n");
1905
1906
1907 qphy->pcs_misc = qphy->tx2;
1908 qphy->tx2 = qphy->tx + QMP_PHY_LEGACY_LANE_STRIDE;
1909 qphy->rx2 = qphy->rx + QMP_PHY_LEGACY_LANE_STRIDE;
1910
1911 } else {
1912 qphy->pcs_misc = of_iomap(np, 5);
1913 }
1914
1915 } else {
1916 qphy->pcs_misc = of_iomap(np, 3);
1917 }
1918
1919 if (!qphy->pcs_misc)
1920 dev_vdbg(dev, "PHY pcs_misc-reg not used\n");
1921
1922
1923
1924
1925
1926
1927
1928
1929 snprintf(prop_name, sizeof(prop_name), "pipe%d", id);
1930 qphy->pipe_clk = of_clk_get_by_name(np, prop_name);
1931 if (IS_ERR(qphy->pipe_clk)) {
1932 if (qmp->cfg->type == PHY_TYPE_PCIE ||
1933 qmp->cfg->type == PHY_TYPE_USB3) {
1934 ret = PTR_ERR(qphy->pipe_clk);
1935 if (ret != -EPROBE_DEFER)
1936 dev_err(dev,
1937 "failed to get lane%d pipe_clk, %d\n",
1938 id, ret);
1939 return ret;
1940 }
1941 qphy->pipe_clk = NULL;
1942 }
1943
1944
1945 if (qmp->cfg->has_lane_rst) {
1946 snprintf(prop_name, sizeof(prop_name), "lane%d", id);
1947 qphy->lane_rst = of_reset_control_get(np, prop_name);
1948 if (IS_ERR(qphy->lane_rst)) {
1949 dev_err(dev, "failed to get lane%d reset\n", id);
1950 return PTR_ERR(qphy->lane_rst);
1951 }
1952 }
1953
1954 if (qmp->cfg->type == PHY_TYPE_UFS)
1955 ops = &qcom_qmp_ufs_ops;
1956
1957 generic_phy = devm_phy_create(dev, np, ops);
1958 if (IS_ERR(generic_phy)) {
1959 ret = PTR_ERR(generic_phy);
1960 dev_err(dev, "failed to create qphy %d\n", ret);
1961 return ret;
1962 }
1963
1964 qphy->phy = generic_phy;
1965 qphy->index = id;
1966 qphy->qmp = qmp;
1967 qmp->phys[id] = qphy;
1968 phy_set_drvdata(generic_phy, qphy);
1969
1970 return 0;
1971}
1972
1973static const struct of_device_id qcom_qmp_phy_of_match_table[] = {
1974 {
1975 .compatible = "qcom,msm8996-qmp-pcie-phy",
1976 .data = &msm8996_pciephy_cfg,
1977 }, {
1978 .compatible = "qcom,msm8996-qmp-usb3-phy",
1979 .data = &msm8996_usb3phy_cfg,
1980 }, {
1981 .compatible = "qcom,msm8998-qmp-pcie-phy",
1982 .data = &msm8998_pciephy_cfg,
1983 }, {
1984 .compatible = "qcom,msm8998-qmp-ufs-phy",
1985 .data = &sdm845_ufsphy_cfg,
1986 }, {
1987 .compatible = "qcom,ipq8074-qmp-pcie-phy",
1988 .data = &ipq8074_pciephy_cfg,
1989 }, {
1990 .compatible = "qcom,sdm845-qmp-usb3-phy",
1991 .data = &qmp_v3_usb3phy_cfg,
1992 }, {
1993 .compatible = "qcom,sdm845-qmp-usb3-uni-phy",
1994 .data = &qmp_v3_usb3_uniphy_cfg,
1995 }, {
1996 .compatible = "qcom,sdm845-qmp-ufs-phy",
1997 .data = &sdm845_ufsphy_cfg,
1998 }, {
1999 .compatible = "qcom,msm8998-qmp-usb3-phy",
2000 .data = &msm8998_usb3phy_cfg,
2001 },
2002 { },
2003};
2004MODULE_DEVICE_TABLE(of, qcom_qmp_phy_of_match_table);
2005
2006static const struct dev_pm_ops qcom_qmp_phy_pm_ops = {
2007 SET_RUNTIME_PM_OPS(qcom_qmp_phy_runtime_suspend,
2008 qcom_qmp_phy_runtime_resume, NULL)
2009};
2010
2011static int qcom_qmp_phy_probe(struct platform_device *pdev)
2012{
2013 struct qcom_qmp *qmp;
2014 struct device *dev = &pdev->dev;
2015 struct resource *res;
2016 struct device_node *child;
2017 struct phy_provider *phy_provider;
2018 void __iomem *base;
2019 int num, id;
2020 int ret;
2021
2022 qmp = devm_kzalloc(dev, sizeof(*qmp), GFP_KERNEL);
2023 if (!qmp)
2024 return -ENOMEM;
2025
2026 qmp->dev = dev;
2027 dev_set_drvdata(dev, qmp);
2028
2029
2030 qmp->cfg = of_device_get_match_data(dev);
2031 if (!qmp->cfg)
2032 return -EINVAL;
2033
2034 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2035 base = devm_ioremap_resource(dev, res);
2036 if (IS_ERR(base))
2037 return PTR_ERR(base);
2038
2039
2040 qmp->serdes = base;
2041
2042
2043 if (qmp->cfg->has_phy_dp_com_ctrl) {
2044 res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
2045 "dp_com");
2046 base = devm_ioremap_resource(dev, res);
2047 if (IS_ERR(base))
2048 return PTR_ERR(base);
2049
2050 qmp->dp_com = base;
2051 }
2052
2053 mutex_init(&qmp->phy_mutex);
2054
2055 ret = qcom_qmp_phy_clk_init(dev);
2056 if (ret)
2057 return ret;
2058
2059 ret = qcom_qmp_phy_reset_init(dev);
2060 if (ret)
2061 return ret;
2062
2063 ret = qcom_qmp_phy_vreg_init(dev);
2064 if (ret) {
2065 if (ret != -EPROBE_DEFER)
2066 dev_err(dev, "failed to get regulator supplies: %d\n",
2067 ret);
2068 return ret;
2069 }
2070
2071 num = of_get_available_child_count(dev->of_node);
2072
2073 if (num > qmp->cfg->nlanes)
2074 return -EINVAL;
2075
2076 qmp->phys = devm_kcalloc(dev, num, sizeof(*qmp->phys), GFP_KERNEL);
2077 if (!qmp->phys)
2078 return -ENOMEM;
2079
2080 id = 0;
2081 pm_runtime_set_active(dev);
2082 pm_runtime_enable(dev);
2083
2084
2085
2086
2087 pm_runtime_forbid(dev);
2088
2089 for_each_available_child_of_node(dev->of_node, child) {
2090
2091 ret = qcom_qmp_phy_create(dev, child, id);
2092 if (ret) {
2093 dev_err(dev, "failed to create lane%d phy, %d\n",
2094 id, ret);
2095 pm_runtime_disable(dev);
2096 return ret;
2097 }
2098
2099
2100
2101
2102
2103 ret = phy_pipe_clk_register(qmp, child);
2104 if (ret) {
2105 dev_err(qmp->dev,
2106 "failed to register pipe clock source\n");
2107 pm_runtime_disable(dev);
2108 return ret;
2109 }
2110 id++;
2111 }
2112
2113 phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
2114 if (!IS_ERR(phy_provider))
2115 dev_info(dev, "Registered Qcom-QMP phy\n");
2116 else
2117 pm_runtime_disable(dev);
2118
2119 return PTR_ERR_OR_ZERO(phy_provider);
2120}
2121
2122static struct platform_driver qcom_qmp_phy_driver = {
2123 .probe = qcom_qmp_phy_probe,
2124 .driver = {
2125 .name = "qcom-qmp-phy",
2126 .pm = &qcom_qmp_phy_pm_ops,
2127 .of_match_table = qcom_qmp_phy_of_match_table,
2128 },
2129};
2130
2131module_platform_driver(qcom_qmp_phy_driver);
2132
2133MODULE_AUTHOR("Vivek Gautam <vivek.gautam@codeaurora.org>");
2134MODULE_DESCRIPTION("Qualcomm QMP PHY driver");
2135MODULE_LICENSE("GPL v2");
2136