1 | // SPDX-License-Identifier: GPL-2.0+ |
2 | /* |
3 | * Copyright 2012-2014 Freescale Semiconductor, Inc. |
4 | * Copyright (C) 2012 Marek Vasut <marex@denx.de> |
5 | * on behalf of DENX Software Engineering GmbH |
6 | */ |
7 | |
8 | #include <linux/module.h> |
9 | #include <linux/kernel.h> |
10 | #include <linux/platform_device.h> |
11 | #include <linux/clk.h> |
12 | #include <linux/usb/otg.h> |
13 | #include <linux/stmp_device.h> |
14 | #include <linux/delay.h> |
15 | #include <linux/err.h> |
16 | #include <linux/io.h> |
17 | #include <linux/of.h> |
18 | #include <linux/regmap.h> |
19 | #include <linux/mfd/syscon.h> |
20 | #include <linux/iopoll.h> |
21 | |
22 | #define DRIVER_NAME "mxs_phy" |
23 | |
24 | /* Register Macro */ |
25 | #define HW_USBPHY_PWD 0x00 |
26 | #define HW_USBPHY_TX 0x10 |
27 | #define HW_USBPHY_CTRL 0x30 |
28 | #define HW_USBPHY_CTRL_SET 0x34 |
29 | #define HW_USBPHY_CTRL_CLR 0x38 |
30 | |
31 | #define HW_USBPHY_DEBUG_SET 0x54 |
32 | #define HW_USBPHY_DEBUG_CLR 0x58 |
33 | |
34 | #define HW_USBPHY_IP 0x90 |
35 | #define HW_USBPHY_IP_SET 0x94 |
36 | #define HW_USBPHY_IP_CLR 0x98 |
37 | |
38 | #define GM_USBPHY_TX_TXCAL45DP(x) (((x) & 0xf) << 16) |
39 | #define GM_USBPHY_TX_TXCAL45DN(x) (((x) & 0xf) << 8) |
40 | #define GM_USBPHY_TX_D_CAL(x) (((x) & 0xf) << 0) |
41 | |
42 | /* imx7ulp */ |
43 | #define HW_USBPHY_PLL_SIC 0xa0 |
44 | #define HW_USBPHY_PLL_SIC_SET 0xa4 |
45 | #define HW_USBPHY_PLL_SIC_CLR 0xa8 |
46 | |
47 | #define BM_USBPHY_CTRL_SFTRST BIT(31) |
48 | #define BM_USBPHY_CTRL_CLKGATE BIT(30) |
49 | #define BM_USBPHY_CTRL_OTG_ID_VALUE BIT(27) |
50 | #define BM_USBPHY_CTRL_ENAUTOSET_USBCLKS BIT(26) |
51 | #define BM_USBPHY_CTRL_ENAUTOCLR_USBCLKGATE BIT(25) |
52 | #define BM_USBPHY_CTRL_ENVBUSCHG_WKUP BIT(23) |
53 | #define BM_USBPHY_CTRL_ENIDCHG_WKUP BIT(22) |
54 | #define BM_USBPHY_CTRL_ENDPDMCHG_WKUP BIT(21) |
55 | #define BM_USBPHY_CTRL_ENAUTOCLR_PHY_PWD BIT(20) |
56 | #define BM_USBPHY_CTRL_ENAUTOCLR_CLKGATE BIT(19) |
57 | #define BM_USBPHY_CTRL_ENAUTO_PWRON_PLL BIT(18) |
58 | #define BM_USBPHY_CTRL_ENUTMILEVEL3 BIT(15) |
59 | #define BM_USBPHY_CTRL_ENUTMILEVEL2 BIT(14) |
60 | #define BM_USBPHY_CTRL_ENHOSTDISCONDETECT BIT(1) |
61 | |
62 | #define BM_USBPHY_IP_FIX (BIT(17) | BIT(18)) |
63 | |
64 | #define BM_USBPHY_DEBUG_CLKGATE BIT(30) |
65 | /* imx7ulp */ |
66 | #define BM_USBPHY_PLL_LOCK BIT(31) |
67 | #define BM_USBPHY_PLL_REG_ENABLE BIT(21) |
68 | #define BM_USBPHY_PLL_BYPASS BIT(16) |
69 | #define BM_USBPHY_PLL_POWER BIT(12) |
70 | #define BM_USBPHY_PLL_EN_USB_CLKS BIT(6) |
71 | |
72 | /* Anatop Registers */ |
73 | #define ANADIG_ANA_MISC0 0x150 |
74 | #define ANADIG_ANA_MISC0_SET 0x154 |
75 | #define ANADIG_ANA_MISC0_CLR 0x158 |
76 | |
77 | #define ANADIG_USB1_CHRG_DETECT_SET 0x1b4 |
78 | #define ANADIG_USB1_CHRG_DETECT_CLR 0x1b8 |
79 | #define ANADIG_USB2_CHRG_DETECT_SET 0x214 |
80 | #define ANADIG_USB1_CHRG_DETECT_EN_B BIT(20) |
81 | #define ANADIG_USB1_CHRG_DETECT_CHK_CHRG_B BIT(19) |
82 | #define ANADIG_USB1_CHRG_DETECT_CHK_CONTACT BIT(18) |
83 | |
84 | #define ANADIG_USB1_VBUS_DET_STAT 0x1c0 |
85 | #define ANADIG_USB1_VBUS_DET_STAT_VBUS_VALID BIT(3) |
86 | |
87 | #define ANADIG_USB1_CHRG_DET_STAT 0x1d0 |
88 | #define ANADIG_USB1_CHRG_DET_STAT_DM_STATE BIT(2) |
89 | #define ANADIG_USB1_CHRG_DET_STAT_CHRG_DETECTED BIT(1) |
90 | #define ANADIG_USB1_CHRG_DET_STAT_PLUG_CONTACT BIT(0) |
91 | |
92 | #define ANADIG_USB2_VBUS_DET_STAT 0x220 |
93 | |
94 | #define ANADIG_USB1_LOOPBACK_SET 0x1e4 |
95 | #define ANADIG_USB1_LOOPBACK_CLR 0x1e8 |
96 | #define ANADIG_USB1_LOOPBACK_UTMI_TESTSTART BIT(0) |
97 | |
98 | #define ANADIG_USB2_LOOPBACK_SET 0x244 |
99 | #define ANADIG_USB2_LOOPBACK_CLR 0x248 |
100 | |
101 | #define ANADIG_USB1_MISC 0x1f0 |
102 | #define ANADIG_USB2_MISC 0x250 |
103 | |
104 | #define BM_ANADIG_ANA_MISC0_STOP_MODE_CONFIG BIT(12) |
105 | #define BM_ANADIG_ANA_MISC0_STOP_MODE_CONFIG_SL BIT(11) |
106 | |
107 | #define BM_ANADIG_USB1_VBUS_DET_STAT_VBUS_VALID BIT(3) |
108 | #define BM_ANADIG_USB2_VBUS_DET_STAT_VBUS_VALID BIT(3) |
109 | |
110 | #define BM_ANADIG_USB1_LOOPBACK_UTMI_DIG_TST1 BIT(2) |
111 | #define BM_ANADIG_USB1_LOOPBACK_TSTI_TX_EN BIT(5) |
112 | #define BM_ANADIG_USB2_LOOPBACK_UTMI_DIG_TST1 BIT(2) |
113 | #define BM_ANADIG_USB2_LOOPBACK_TSTI_TX_EN BIT(5) |
114 | |
115 | #define BM_ANADIG_USB1_MISC_RX_VPIN_FS BIT(29) |
116 | #define BM_ANADIG_USB1_MISC_RX_VMIN_FS BIT(28) |
117 | #define BM_ANADIG_USB2_MISC_RX_VPIN_FS BIT(29) |
118 | #define BM_ANADIG_USB2_MISC_RX_VMIN_FS BIT(28) |
119 | |
120 | #define to_mxs_phy(p) container_of((p), struct mxs_phy, phy) |
121 | |
122 | /* Do disconnection between PHY and controller without vbus */ |
123 | #define MXS_PHY_DISCONNECT_LINE_WITHOUT_VBUS BIT(0) |
124 | |
125 | /* |
126 | * The PHY will be in messy if there is a wakeup after putting |
127 | * bus to suspend (set portsc.suspendM) but before setting PHY to low |
128 | * power mode (set portsc.phcd). |
129 | */ |
130 | #define MXS_PHY_ABNORMAL_IN_SUSPEND BIT(1) |
131 | |
132 | /* |
133 | * The SOF sends too fast after resuming, it will cause disconnection |
134 | * between host and high speed device. |
135 | */ |
136 | #define MXS_PHY_SENDING_SOF_TOO_FAST BIT(2) |
137 | |
138 | /* |
139 | * IC has bug fixes logic, they include |
140 | * MXS_PHY_ABNORMAL_IN_SUSPEND and MXS_PHY_SENDING_SOF_TOO_FAST |
141 | * which are described at above flags, the RTL will handle it |
142 | * according to different versions. |
143 | */ |
144 | #define MXS_PHY_NEED_IP_FIX BIT(3) |
145 | |
146 | /* Minimum and maximum values for device tree entries */ |
147 | #define MXS_PHY_TX_CAL45_MIN 35 |
148 | #define MXS_PHY_TX_CAL45_MAX 54 |
149 | #define MXS_PHY_TX_D_CAL_MIN 79 |
150 | #define MXS_PHY_TX_D_CAL_MAX 119 |
151 | |
152 | struct mxs_phy_data { |
153 | unsigned int flags; |
154 | }; |
155 | |
156 | static const struct mxs_phy_data imx23_phy_data = { |
157 | .flags = MXS_PHY_ABNORMAL_IN_SUSPEND | MXS_PHY_SENDING_SOF_TOO_FAST, |
158 | }; |
159 | |
160 | static const struct mxs_phy_data imx6q_phy_data = { |
161 | .flags = MXS_PHY_SENDING_SOF_TOO_FAST | |
162 | MXS_PHY_DISCONNECT_LINE_WITHOUT_VBUS | |
163 | MXS_PHY_NEED_IP_FIX, |
164 | }; |
165 | |
166 | static const struct mxs_phy_data imx6sl_phy_data = { |
167 | .flags = MXS_PHY_DISCONNECT_LINE_WITHOUT_VBUS | |
168 | MXS_PHY_NEED_IP_FIX, |
169 | }; |
170 | |
171 | static const struct mxs_phy_data vf610_phy_data = { |
172 | .flags = MXS_PHY_DISCONNECT_LINE_WITHOUT_VBUS | |
173 | MXS_PHY_NEED_IP_FIX, |
174 | }; |
175 | |
176 | static const struct mxs_phy_data imx6sx_phy_data = { |
177 | .flags = MXS_PHY_DISCONNECT_LINE_WITHOUT_VBUS, |
178 | }; |
179 | |
180 | static const struct mxs_phy_data imx6ul_phy_data = { |
181 | .flags = MXS_PHY_DISCONNECT_LINE_WITHOUT_VBUS, |
182 | }; |
183 | |
184 | static const struct mxs_phy_data imx7ulp_phy_data = { |
185 | }; |
186 | |
187 | static const struct of_device_id mxs_phy_dt_ids[] = { |
188 | { .compatible = "fsl,imx6sx-usbphy" , .data = &imx6sx_phy_data, }, |
189 | { .compatible = "fsl,imx6sl-usbphy" , .data = &imx6sl_phy_data, }, |
190 | { .compatible = "fsl,imx6q-usbphy" , .data = &imx6q_phy_data, }, |
191 | { .compatible = "fsl,imx23-usbphy" , .data = &imx23_phy_data, }, |
192 | { .compatible = "fsl,vf610-usbphy" , .data = &vf610_phy_data, }, |
193 | { .compatible = "fsl,imx6ul-usbphy" , .data = &imx6ul_phy_data, }, |
194 | { .compatible = "fsl,imx7ulp-usbphy" , .data = &imx7ulp_phy_data, }, |
195 | { /* sentinel */ } |
196 | }; |
197 | MODULE_DEVICE_TABLE(of, mxs_phy_dt_ids); |
198 | |
199 | struct mxs_phy { |
200 | struct usb_phy phy; |
201 | struct clk *clk; |
202 | const struct mxs_phy_data *data; |
203 | struct regmap *regmap_anatop; |
204 | int port_id; |
205 | u32 tx_reg_set; |
206 | u32 tx_reg_mask; |
207 | }; |
208 | |
209 | static inline bool is_imx6q_phy(struct mxs_phy *mxs_phy) |
210 | { |
211 | return mxs_phy->data == &imx6q_phy_data; |
212 | } |
213 | |
214 | static inline bool is_imx6sl_phy(struct mxs_phy *mxs_phy) |
215 | { |
216 | return mxs_phy->data == &imx6sl_phy_data; |
217 | } |
218 | |
219 | static inline bool is_imx7ulp_phy(struct mxs_phy *mxs_phy) |
220 | { |
221 | return mxs_phy->data == &imx7ulp_phy_data; |
222 | } |
223 | |
224 | /* |
225 | * PHY needs some 32K cycles to switch from 32K clock to |
226 | * bus (such as AHB/AXI, etc) clock. |
227 | */ |
228 | static void mxs_phy_clock_switch_delay(void) |
229 | { |
230 | usleep_range(min: 300, max: 400); |
231 | } |
232 | |
233 | static void mxs_phy_tx_init(struct mxs_phy *mxs_phy) |
234 | { |
235 | void __iomem *base = mxs_phy->phy.io_priv; |
236 | u32 phytx; |
237 | |
238 | /* Update TX register if there is anything to write */ |
239 | if (mxs_phy->tx_reg_mask) { |
240 | phytx = readl(addr: base + HW_USBPHY_TX); |
241 | phytx &= ~mxs_phy->tx_reg_mask; |
242 | phytx |= mxs_phy->tx_reg_set; |
243 | writel(val: phytx, addr: base + HW_USBPHY_TX); |
244 | } |
245 | } |
246 | |
247 | static int mxs_phy_pll_enable(void __iomem *base, bool enable) |
248 | { |
249 | int ret = 0; |
250 | |
251 | if (enable) { |
252 | u32 value; |
253 | |
254 | writel(BM_USBPHY_PLL_REG_ENABLE, addr: base + HW_USBPHY_PLL_SIC_SET); |
255 | writel(BM_USBPHY_PLL_BYPASS, addr: base + HW_USBPHY_PLL_SIC_CLR); |
256 | writel(BM_USBPHY_PLL_POWER, addr: base + HW_USBPHY_PLL_SIC_SET); |
257 | ret = readl_poll_timeout(base + HW_USBPHY_PLL_SIC, |
258 | value, (value & BM_USBPHY_PLL_LOCK) != 0, |
259 | 100, 10000); |
260 | if (ret) |
261 | return ret; |
262 | |
263 | writel(BM_USBPHY_PLL_EN_USB_CLKS, addr: base + |
264 | HW_USBPHY_PLL_SIC_SET); |
265 | } else { |
266 | writel(BM_USBPHY_PLL_EN_USB_CLKS, addr: base + |
267 | HW_USBPHY_PLL_SIC_CLR); |
268 | writel(BM_USBPHY_PLL_POWER, addr: base + HW_USBPHY_PLL_SIC_CLR); |
269 | writel(BM_USBPHY_PLL_BYPASS, addr: base + HW_USBPHY_PLL_SIC_SET); |
270 | writel(BM_USBPHY_PLL_REG_ENABLE, addr: base + HW_USBPHY_PLL_SIC_CLR); |
271 | } |
272 | |
273 | return ret; |
274 | } |
275 | |
276 | static int mxs_phy_hw_init(struct mxs_phy *mxs_phy) |
277 | { |
278 | int ret; |
279 | void __iomem *base = mxs_phy->phy.io_priv; |
280 | |
281 | if (is_imx7ulp_phy(mxs_phy)) { |
282 | ret = mxs_phy_pll_enable(base, enable: true); |
283 | if (ret) |
284 | return ret; |
285 | } |
286 | |
287 | ret = stmp_reset_block(base + HW_USBPHY_CTRL); |
288 | if (ret) |
289 | goto disable_pll; |
290 | |
291 | /* Power up the PHY */ |
292 | writel(val: 0, addr: base + HW_USBPHY_PWD); |
293 | |
294 | /* |
295 | * USB PHY Ctrl Setting |
296 | * - Auto clock/power on |
297 | * - Enable full/low speed support |
298 | */ |
299 | writel(BM_USBPHY_CTRL_ENAUTOSET_USBCLKS | |
300 | BM_USBPHY_CTRL_ENAUTOCLR_USBCLKGATE | |
301 | BM_USBPHY_CTRL_ENAUTOCLR_PHY_PWD | |
302 | BM_USBPHY_CTRL_ENAUTOCLR_CLKGATE | |
303 | BM_USBPHY_CTRL_ENAUTO_PWRON_PLL | |
304 | BM_USBPHY_CTRL_ENUTMILEVEL2 | |
305 | BM_USBPHY_CTRL_ENUTMILEVEL3, |
306 | addr: base + HW_USBPHY_CTRL_SET); |
307 | |
308 | if (mxs_phy->data->flags & MXS_PHY_NEED_IP_FIX) |
309 | writel(BM_USBPHY_IP_FIX, addr: base + HW_USBPHY_IP_SET); |
310 | |
311 | if (mxs_phy->regmap_anatop) { |
312 | unsigned int reg = mxs_phy->port_id ? |
313 | ANADIG_USB1_CHRG_DETECT_SET : |
314 | ANADIG_USB2_CHRG_DETECT_SET; |
315 | /* |
316 | * The external charger detector needs to be disabled, |
317 | * or the signal at DP will be poor |
318 | */ |
319 | regmap_write(map: mxs_phy->regmap_anatop, reg, |
320 | ANADIG_USB1_CHRG_DETECT_EN_B | |
321 | ANADIG_USB1_CHRG_DETECT_CHK_CHRG_B); |
322 | } |
323 | |
324 | mxs_phy_tx_init(mxs_phy); |
325 | |
326 | return 0; |
327 | |
328 | disable_pll: |
329 | if (is_imx7ulp_phy(mxs_phy)) |
330 | mxs_phy_pll_enable(base, enable: false); |
331 | return ret; |
332 | } |
333 | |
334 | /* Return true if the vbus is there */ |
335 | static bool mxs_phy_get_vbus_status(struct mxs_phy *mxs_phy) |
336 | { |
337 | unsigned int vbus_value = 0; |
338 | |
339 | if (!mxs_phy->regmap_anatop) |
340 | return false; |
341 | |
342 | if (mxs_phy->port_id == 0) |
343 | regmap_read(map: mxs_phy->regmap_anatop, |
344 | ANADIG_USB1_VBUS_DET_STAT, |
345 | val: &vbus_value); |
346 | else if (mxs_phy->port_id == 1) |
347 | regmap_read(map: mxs_phy->regmap_anatop, |
348 | ANADIG_USB2_VBUS_DET_STAT, |
349 | val: &vbus_value); |
350 | |
351 | if (vbus_value & BM_ANADIG_USB1_VBUS_DET_STAT_VBUS_VALID) |
352 | return true; |
353 | else |
354 | return false; |
355 | } |
356 | |
357 | static void __mxs_phy_disconnect_line(struct mxs_phy *mxs_phy, bool disconnect) |
358 | { |
359 | void __iomem *base = mxs_phy->phy.io_priv; |
360 | u32 reg; |
361 | |
362 | if (disconnect) |
363 | writel_relaxed(BM_USBPHY_DEBUG_CLKGATE, |
364 | base + HW_USBPHY_DEBUG_CLR); |
365 | |
366 | if (mxs_phy->port_id == 0) { |
367 | reg = disconnect ? ANADIG_USB1_LOOPBACK_SET |
368 | : ANADIG_USB1_LOOPBACK_CLR; |
369 | regmap_write(map: mxs_phy->regmap_anatop, reg, |
370 | BM_ANADIG_USB1_LOOPBACK_UTMI_DIG_TST1 | |
371 | BM_ANADIG_USB1_LOOPBACK_TSTI_TX_EN); |
372 | } else if (mxs_phy->port_id == 1) { |
373 | reg = disconnect ? ANADIG_USB2_LOOPBACK_SET |
374 | : ANADIG_USB2_LOOPBACK_CLR; |
375 | regmap_write(map: mxs_phy->regmap_anatop, reg, |
376 | BM_ANADIG_USB2_LOOPBACK_UTMI_DIG_TST1 | |
377 | BM_ANADIG_USB2_LOOPBACK_TSTI_TX_EN); |
378 | } |
379 | |
380 | if (!disconnect) |
381 | writel_relaxed(BM_USBPHY_DEBUG_CLKGATE, |
382 | base + HW_USBPHY_DEBUG_SET); |
383 | |
384 | /* Delay some time, and let Linestate be SE0 for controller */ |
385 | if (disconnect) |
386 | usleep_range(min: 500, max: 1000); |
387 | } |
388 | |
389 | static bool mxs_phy_is_otg_host(struct mxs_phy *mxs_phy) |
390 | { |
391 | return IS_ENABLED(CONFIG_USB_OTG) && |
392 | mxs_phy->phy.last_event == USB_EVENT_ID; |
393 | } |
394 | |
395 | static void mxs_phy_disconnect_line(struct mxs_phy *mxs_phy, bool on) |
396 | { |
397 | bool vbus_is_on = false; |
398 | enum usb_phy_events last_event = mxs_phy->phy.last_event; |
399 | |
400 | /* If the SoCs don't need to disconnect line without vbus, quit */ |
401 | if (!(mxs_phy->data->flags & MXS_PHY_DISCONNECT_LINE_WITHOUT_VBUS)) |
402 | return; |
403 | |
404 | /* If the SoCs don't have anatop, quit */ |
405 | if (!mxs_phy->regmap_anatop) |
406 | return; |
407 | |
408 | vbus_is_on = mxs_phy_get_vbus_status(mxs_phy); |
409 | |
410 | if (on && ((!vbus_is_on && !mxs_phy_is_otg_host(mxs_phy)) |
411 | || (last_event == USB_EVENT_VBUS))) |
412 | __mxs_phy_disconnect_line(mxs_phy, disconnect: true); |
413 | else |
414 | __mxs_phy_disconnect_line(mxs_phy, disconnect: false); |
415 | |
416 | } |
417 | |
418 | static int mxs_phy_init(struct usb_phy *phy) |
419 | { |
420 | int ret; |
421 | struct mxs_phy *mxs_phy = to_mxs_phy(phy); |
422 | |
423 | mxs_phy_clock_switch_delay(); |
424 | ret = clk_prepare_enable(clk: mxs_phy->clk); |
425 | if (ret) |
426 | return ret; |
427 | |
428 | return mxs_phy_hw_init(mxs_phy); |
429 | } |
430 | |
431 | static void mxs_phy_shutdown(struct usb_phy *phy) |
432 | { |
433 | struct mxs_phy *mxs_phy = to_mxs_phy(phy); |
434 | u32 value = BM_USBPHY_CTRL_ENVBUSCHG_WKUP | |
435 | BM_USBPHY_CTRL_ENDPDMCHG_WKUP | |
436 | BM_USBPHY_CTRL_ENIDCHG_WKUP | |
437 | BM_USBPHY_CTRL_ENAUTOSET_USBCLKS | |
438 | BM_USBPHY_CTRL_ENAUTOCLR_USBCLKGATE | |
439 | BM_USBPHY_CTRL_ENAUTOCLR_PHY_PWD | |
440 | BM_USBPHY_CTRL_ENAUTOCLR_CLKGATE | |
441 | BM_USBPHY_CTRL_ENAUTO_PWRON_PLL; |
442 | |
443 | writel(val: value, addr: phy->io_priv + HW_USBPHY_CTRL_CLR); |
444 | writel(val: 0xffffffff, addr: phy->io_priv + HW_USBPHY_PWD); |
445 | |
446 | writel(BM_USBPHY_CTRL_CLKGATE, |
447 | addr: phy->io_priv + HW_USBPHY_CTRL_SET); |
448 | |
449 | if (is_imx7ulp_phy(mxs_phy)) |
450 | mxs_phy_pll_enable(base: phy->io_priv, enable: false); |
451 | |
452 | clk_disable_unprepare(clk: mxs_phy->clk); |
453 | } |
454 | |
455 | static bool mxs_phy_is_low_speed_connection(struct mxs_phy *mxs_phy) |
456 | { |
457 | unsigned int line_state; |
458 | /* bit definition is the same for all controllers */ |
459 | unsigned int dp_bit = BM_ANADIG_USB1_MISC_RX_VPIN_FS, |
460 | dm_bit = BM_ANADIG_USB1_MISC_RX_VMIN_FS; |
461 | unsigned int reg = ANADIG_USB1_MISC; |
462 | |
463 | /* If the SoCs don't have anatop, quit */ |
464 | if (!mxs_phy->regmap_anatop) |
465 | return false; |
466 | |
467 | if (mxs_phy->port_id == 0) |
468 | reg = ANADIG_USB1_MISC; |
469 | else if (mxs_phy->port_id == 1) |
470 | reg = ANADIG_USB2_MISC; |
471 | |
472 | regmap_read(map: mxs_phy->regmap_anatop, reg, val: &line_state); |
473 | |
474 | if ((line_state & (dp_bit | dm_bit)) == dm_bit) |
475 | return true; |
476 | else |
477 | return false; |
478 | } |
479 | |
480 | static int mxs_phy_suspend(struct usb_phy *x, int suspend) |
481 | { |
482 | int ret; |
483 | struct mxs_phy *mxs_phy = to_mxs_phy(x); |
484 | bool low_speed_connection, vbus_is_on; |
485 | |
486 | low_speed_connection = mxs_phy_is_low_speed_connection(mxs_phy); |
487 | vbus_is_on = mxs_phy_get_vbus_status(mxs_phy); |
488 | |
489 | if (suspend) { |
490 | /* |
491 | * FIXME: Do not power down RXPWD1PT1 bit for low speed |
492 | * connect. The low speed connection will have problem at |
493 | * very rare cases during usb suspend and resume process. |
494 | */ |
495 | if (low_speed_connection & vbus_is_on) { |
496 | /* |
497 | * If value to be set as pwd value is not 0xffffffff, |
498 | * several 32Khz cycles are needed. |
499 | */ |
500 | mxs_phy_clock_switch_delay(); |
501 | writel(val: 0xffbfffff, addr: x->io_priv + HW_USBPHY_PWD); |
502 | } else { |
503 | writel(val: 0xffffffff, addr: x->io_priv + HW_USBPHY_PWD); |
504 | } |
505 | writel(BM_USBPHY_CTRL_CLKGATE, |
506 | addr: x->io_priv + HW_USBPHY_CTRL_SET); |
507 | clk_disable_unprepare(clk: mxs_phy->clk); |
508 | } else { |
509 | mxs_phy_clock_switch_delay(); |
510 | ret = clk_prepare_enable(clk: mxs_phy->clk); |
511 | if (ret) |
512 | return ret; |
513 | writel(BM_USBPHY_CTRL_CLKGATE, |
514 | addr: x->io_priv + HW_USBPHY_CTRL_CLR); |
515 | writel(val: 0, addr: x->io_priv + HW_USBPHY_PWD); |
516 | } |
517 | |
518 | return 0; |
519 | } |
520 | |
521 | static int mxs_phy_set_wakeup(struct usb_phy *x, bool enabled) |
522 | { |
523 | struct mxs_phy *mxs_phy = to_mxs_phy(x); |
524 | u32 value = BM_USBPHY_CTRL_ENVBUSCHG_WKUP | |
525 | BM_USBPHY_CTRL_ENDPDMCHG_WKUP | |
526 | BM_USBPHY_CTRL_ENIDCHG_WKUP; |
527 | if (enabled) { |
528 | mxs_phy_disconnect_line(mxs_phy, on: true); |
529 | writel_relaxed(value, x->io_priv + HW_USBPHY_CTRL_SET); |
530 | } else { |
531 | writel_relaxed(value, x->io_priv + HW_USBPHY_CTRL_CLR); |
532 | mxs_phy_disconnect_line(mxs_phy, on: false); |
533 | } |
534 | |
535 | return 0; |
536 | } |
537 | |
538 | static int mxs_phy_on_connect(struct usb_phy *phy, |
539 | enum usb_device_speed speed) |
540 | { |
541 | dev_dbg(phy->dev, "%s device has connected\n" , |
542 | (speed == USB_SPEED_HIGH) ? "HS" : "FS/LS" ); |
543 | |
544 | if (speed == USB_SPEED_HIGH) |
545 | writel(BM_USBPHY_CTRL_ENHOSTDISCONDETECT, |
546 | addr: phy->io_priv + HW_USBPHY_CTRL_SET); |
547 | |
548 | return 0; |
549 | } |
550 | |
551 | static int mxs_phy_on_disconnect(struct usb_phy *phy, |
552 | enum usb_device_speed speed) |
553 | { |
554 | dev_dbg(phy->dev, "%s device has disconnected\n" , |
555 | (speed == USB_SPEED_HIGH) ? "HS" : "FS/LS" ); |
556 | |
557 | /* Sometimes, the speed is not high speed when the error occurs */ |
558 | if (readl(addr: phy->io_priv + HW_USBPHY_CTRL) & |
559 | BM_USBPHY_CTRL_ENHOSTDISCONDETECT) |
560 | writel(BM_USBPHY_CTRL_ENHOSTDISCONDETECT, |
561 | addr: phy->io_priv + HW_USBPHY_CTRL_CLR); |
562 | |
563 | return 0; |
564 | } |
565 | |
566 | #define MXS_USB_CHARGER_DATA_CONTACT_TIMEOUT 100 |
567 | static int mxs_charger_data_contact_detect(struct mxs_phy *x) |
568 | { |
569 | struct regmap *regmap = x->regmap_anatop; |
570 | int i, stable_contact_count = 0; |
571 | u32 val; |
572 | |
573 | /* Check if vbus is valid */ |
574 | regmap_read(map: regmap, ANADIG_USB1_VBUS_DET_STAT, val: &val); |
575 | if (!(val & ANADIG_USB1_VBUS_DET_STAT_VBUS_VALID)) { |
576 | dev_err(x->phy.dev, "vbus is not valid\n" ); |
577 | return -EINVAL; |
578 | } |
579 | |
580 | /* Enable charger detector */ |
581 | regmap_write(map: regmap, ANADIG_USB1_CHRG_DETECT_CLR, |
582 | ANADIG_USB1_CHRG_DETECT_EN_B); |
583 | /* |
584 | * - Do not check whether a charger is connected to the USB port |
585 | * - Check whether the USB plug has been in contact with each other |
586 | */ |
587 | regmap_write(map: regmap, ANADIG_USB1_CHRG_DETECT_SET, |
588 | ANADIG_USB1_CHRG_DETECT_CHK_CONTACT | |
589 | ANADIG_USB1_CHRG_DETECT_CHK_CHRG_B); |
590 | |
591 | /* Check if plug is connected */ |
592 | for (i = 0; i < MXS_USB_CHARGER_DATA_CONTACT_TIMEOUT; i++) { |
593 | regmap_read(map: regmap, ANADIG_USB1_CHRG_DET_STAT, val: &val); |
594 | if (val & ANADIG_USB1_CHRG_DET_STAT_PLUG_CONTACT) { |
595 | stable_contact_count++; |
596 | if (stable_contact_count > 5) |
597 | /* Data pin makes contact */ |
598 | break; |
599 | else |
600 | usleep_range(min: 5000, max: 10000); |
601 | } else { |
602 | stable_contact_count = 0; |
603 | usleep_range(min: 5000, max: 6000); |
604 | } |
605 | } |
606 | |
607 | if (i == MXS_USB_CHARGER_DATA_CONTACT_TIMEOUT) { |
608 | dev_err(x->phy.dev, |
609 | "Data pin can't make good contact.\n" ); |
610 | /* Disable charger detector */ |
611 | regmap_write(map: regmap, ANADIG_USB1_CHRG_DETECT_SET, |
612 | ANADIG_USB1_CHRG_DETECT_EN_B | |
613 | ANADIG_USB1_CHRG_DETECT_CHK_CHRG_B); |
614 | return -ENXIO; |
615 | } |
616 | |
617 | return 0; |
618 | } |
619 | |
620 | static enum usb_charger_type mxs_charger_primary_detection(struct mxs_phy *x) |
621 | { |
622 | struct regmap *regmap = x->regmap_anatop; |
623 | enum usb_charger_type chgr_type = UNKNOWN_TYPE; |
624 | u32 val; |
625 | |
626 | /* |
627 | * - Do check whether a charger is connected to the USB port |
628 | * - Do not Check whether the USB plug has been in contact with |
629 | * each other |
630 | */ |
631 | regmap_write(map: regmap, ANADIG_USB1_CHRG_DETECT_CLR, |
632 | ANADIG_USB1_CHRG_DETECT_CHK_CONTACT | |
633 | ANADIG_USB1_CHRG_DETECT_CHK_CHRG_B); |
634 | |
635 | msleep(msecs: 100); |
636 | |
637 | /* Check if it is a charger */ |
638 | regmap_read(map: regmap, ANADIG_USB1_CHRG_DET_STAT, val: &val); |
639 | if (!(val & ANADIG_USB1_CHRG_DET_STAT_CHRG_DETECTED)) { |
640 | chgr_type = SDP_TYPE; |
641 | dev_dbg(x->phy.dev, "It is a standard downstream port\n" ); |
642 | } |
643 | |
644 | /* Disable charger detector */ |
645 | regmap_write(map: regmap, ANADIG_USB1_CHRG_DETECT_SET, |
646 | ANADIG_USB1_CHRG_DETECT_EN_B | |
647 | ANADIG_USB1_CHRG_DETECT_CHK_CHRG_B); |
648 | |
649 | return chgr_type; |
650 | } |
651 | |
652 | /* |
653 | * It must be called after DP is pulled up, which is used to |
654 | * differentiate DCP and CDP. |
655 | */ |
656 | static enum usb_charger_type mxs_charger_secondary_detection(struct mxs_phy *x) |
657 | { |
658 | struct regmap *regmap = x->regmap_anatop; |
659 | int val; |
660 | |
661 | msleep(msecs: 80); |
662 | |
663 | regmap_read(map: regmap, ANADIG_USB1_CHRG_DET_STAT, val: &val); |
664 | if (val & ANADIG_USB1_CHRG_DET_STAT_DM_STATE) { |
665 | dev_dbg(x->phy.dev, "It is a dedicate charging port\n" ); |
666 | return DCP_TYPE; |
667 | } else { |
668 | dev_dbg(x->phy.dev, "It is a charging downstream port\n" ); |
669 | return CDP_TYPE; |
670 | } |
671 | } |
672 | |
673 | static enum usb_charger_type mxs_phy_charger_detect(struct usb_phy *phy) |
674 | { |
675 | struct mxs_phy *mxs_phy = to_mxs_phy(phy); |
676 | struct regmap *regmap = mxs_phy->regmap_anatop; |
677 | void __iomem *base = phy->io_priv; |
678 | enum usb_charger_type chgr_type = UNKNOWN_TYPE; |
679 | |
680 | if (!regmap) |
681 | return UNKNOWN_TYPE; |
682 | |
683 | if (mxs_charger_data_contact_detect(x: mxs_phy)) |
684 | return chgr_type; |
685 | |
686 | chgr_type = mxs_charger_primary_detection(x: mxs_phy); |
687 | |
688 | if (chgr_type != SDP_TYPE) { |
689 | /* Pull up DP via test */ |
690 | writel_relaxed(BM_USBPHY_DEBUG_CLKGATE, |
691 | base + HW_USBPHY_DEBUG_CLR); |
692 | regmap_write(map: regmap, ANADIG_USB1_LOOPBACK_SET, |
693 | ANADIG_USB1_LOOPBACK_UTMI_TESTSTART); |
694 | |
695 | chgr_type = mxs_charger_secondary_detection(x: mxs_phy); |
696 | |
697 | /* Stop the test */ |
698 | regmap_write(map: regmap, ANADIG_USB1_LOOPBACK_CLR, |
699 | ANADIG_USB1_LOOPBACK_UTMI_TESTSTART); |
700 | writel_relaxed(BM_USBPHY_DEBUG_CLKGATE, |
701 | base + HW_USBPHY_DEBUG_SET); |
702 | } |
703 | |
704 | return chgr_type; |
705 | } |
706 | |
707 | static int mxs_phy_probe(struct platform_device *pdev) |
708 | { |
709 | void __iomem *base; |
710 | struct clk *clk; |
711 | struct mxs_phy *mxs_phy; |
712 | int ret; |
713 | struct device_node *np = pdev->dev.of_node; |
714 | u32 val; |
715 | |
716 | base = devm_platform_ioremap_resource(pdev, index: 0); |
717 | if (IS_ERR(ptr: base)) |
718 | return PTR_ERR(ptr: base); |
719 | |
720 | clk = devm_clk_get(dev: &pdev->dev, NULL); |
721 | if (IS_ERR(ptr: clk)) { |
722 | dev_err(&pdev->dev, |
723 | "can't get the clock, err=%ld" , PTR_ERR(clk)); |
724 | return PTR_ERR(ptr: clk); |
725 | } |
726 | |
727 | mxs_phy = devm_kzalloc(dev: &pdev->dev, size: sizeof(*mxs_phy), GFP_KERNEL); |
728 | if (!mxs_phy) |
729 | return -ENOMEM; |
730 | |
731 | /* Some SoCs don't have anatop registers */ |
732 | if (of_property_present(np, propname: "fsl,anatop" )) { |
733 | mxs_phy->regmap_anatop = syscon_regmap_lookup_by_phandle |
734 | (np, property: "fsl,anatop" ); |
735 | if (IS_ERR(ptr: mxs_phy->regmap_anatop)) { |
736 | dev_dbg(&pdev->dev, |
737 | "failed to find regmap for anatop\n" ); |
738 | return PTR_ERR(ptr: mxs_phy->regmap_anatop); |
739 | } |
740 | } |
741 | |
742 | /* Precompute which bits of the TX register are to be updated, if any */ |
743 | if (!of_property_read_u32(np, propname: "fsl,tx-cal-45-dn-ohms" , out_value: &val) && |
744 | val >= MXS_PHY_TX_CAL45_MIN && val <= MXS_PHY_TX_CAL45_MAX) { |
745 | /* Scale to a 4-bit value */ |
746 | val = (MXS_PHY_TX_CAL45_MAX - val) * 0xF |
747 | / (MXS_PHY_TX_CAL45_MAX - MXS_PHY_TX_CAL45_MIN); |
748 | mxs_phy->tx_reg_mask |= GM_USBPHY_TX_TXCAL45DN(~0); |
749 | mxs_phy->tx_reg_set |= GM_USBPHY_TX_TXCAL45DN(val); |
750 | } |
751 | |
752 | if (!of_property_read_u32(np, propname: "fsl,tx-cal-45-dp-ohms" , out_value: &val) && |
753 | val >= MXS_PHY_TX_CAL45_MIN && val <= MXS_PHY_TX_CAL45_MAX) { |
754 | /* Scale to a 4-bit value. */ |
755 | val = (MXS_PHY_TX_CAL45_MAX - val) * 0xF |
756 | / (MXS_PHY_TX_CAL45_MAX - MXS_PHY_TX_CAL45_MIN); |
757 | mxs_phy->tx_reg_mask |= GM_USBPHY_TX_TXCAL45DP(~0); |
758 | mxs_phy->tx_reg_set |= GM_USBPHY_TX_TXCAL45DP(val); |
759 | } |
760 | |
761 | if (!of_property_read_u32(np, propname: "fsl,tx-d-cal" , out_value: &val) && |
762 | val >= MXS_PHY_TX_D_CAL_MIN && val <= MXS_PHY_TX_D_CAL_MAX) { |
763 | /* Scale to a 4-bit value. Round up the values and heavily |
764 | * weight the rounding by adding 2/3 of the denominator. |
765 | */ |
766 | val = ((MXS_PHY_TX_D_CAL_MAX - val) * 0xF |
767 | + (MXS_PHY_TX_D_CAL_MAX - MXS_PHY_TX_D_CAL_MIN) * 2/3) |
768 | / (MXS_PHY_TX_D_CAL_MAX - MXS_PHY_TX_D_CAL_MIN); |
769 | mxs_phy->tx_reg_mask |= GM_USBPHY_TX_D_CAL(~0); |
770 | mxs_phy->tx_reg_set |= GM_USBPHY_TX_D_CAL(val); |
771 | } |
772 | |
773 | ret = of_alias_get_id(np, stem: "usbphy" ); |
774 | if (ret < 0) |
775 | dev_dbg(&pdev->dev, "failed to get alias id, errno %d\n" , ret); |
776 | mxs_phy->port_id = ret; |
777 | |
778 | mxs_phy->phy.io_priv = base; |
779 | mxs_phy->phy.dev = &pdev->dev; |
780 | mxs_phy->phy.label = DRIVER_NAME; |
781 | mxs_phy->phy.init = mxs_phy_init; |
782 | mxs_phy->phy.shutdown = mxs_phy_shutdown; |
783 | mxs_phy->phy.set_suspend = mxs_phy_suspend; |
784 | mxs_phy->phy.notify_connect = mxs_phy_on_connect; |
785 | mxs_phy->phy.notify_disconnect = mxs_phy_on_disconnect; |
786 | mxs_phy->phy.type = USB_PHY_TYPE_USB2; |
787 | mxs_phy->phy.set_wakeup = mxs_phy_set_wakeup; |
788 | mxs_phy->phy.charger_detect = mxs_phy_charger_detect; |
789 | |
790 | mxs_phy->clk = clk; |
791 | mxs_phy->data = of_device_get_match_data(dev: &pdev->dev); |
792 | |
793 | platform_set_drvdata(pdev, data: mxs_phy); |
794 | |
795 | device_set_wakeup_capable(dev: &pdev->dev, capable: true); |
796 | |
797 | return usb_add_phy_dev(&mxs_phy->phy); |
798 | } |
799 | |
800 | static void mxs_phy_remove(struct platform_device *pdev) |
801 | { |
802 | struct mxs_phy *mxs_phy = platform_get_drvdata(pdev); |
803 | |
804 | usb_remove_phy(&mxs_phy->phy); |
805 | } |
806 | |
807 | #ifdef CONFIG_PM_SLEEP |
808 | static void mxs_phy_enable_ldo_in_suspend(struct mxs_phy *mxs_phy, bool on) |
809 | { |
810 | unsigned int reg = on ? ANADIG_ANA_MISC0_SET : ANADIG_ANA_MISC0_CLR; |
811 | |
812 | /* If the SoCs don't have anatop, quit */ |
813 | if (!mxs_phy->regmap_anatop) |
814 | return; |
815 | |
816 | if (is_imx6q_phy(mxs_phy)) |
817 | regmap_write(map: mxs_phy->regmap_anatop, reg, |
818 | BM_ANADIG_ANA_MISC0_STOP_MODE_CONFIG); |
819 | else if (is_imx6sl_phy(mxs_phy)) |
820 | regmap_write(map: mxs_phy->regmap_anatop, |
821 | reg, BM_ANADIG_ANA_MISC0_STOP_MODE_CONFIG_SL); |
822 | } |
823 | |
824 | static int mxs_phy_system_suspend(struct device *dev) |
825 | { |
826 | struct mxs_phy *mxs_phy = dev_get_drvdata(dev); |
827 | |
828 | if (device_may_wakeup(dev)) |
829 | mxs_phy_enable_ldo_in_suspend(mxs_phy, on: true); |
830 | |
831 | return 0; |
832 | } |
833 | |
834 | static int mxs_phy_system_resume(struct device *dev) |
835 | { |
836 | struct mxs_phy *mxs_phy = dev_get_drvdata(dev); |
837 | |
838 | if (device_may_wakeup(dev)) |
839 | mxs_phy_enable_ldo_in_suspend(mxs_phy, on: false); |
840 | |
841 | return 0; |
842 | } |
843 | #endif /* CONFIG_PM_SLEEP */ |
844 | |
845 | static SIMPLE_DEV_PM_OPS(mxs_phy_pm, mxs_phy_system_suspend, |
846 | mxs_phy_system_resume); |
847 | |
848 | static struct platform_driver mxs_phy_driver = { |
849 | .probe = mxs_phy_probe, |
850 | .remove_new = mxs_phy_remove, |
851 | .driver = { |
852 | .name = DRIVER_NAME, |
853 | .of_match_table = mxs_phy_dt_ids, |
854 | .pm = &mxs_phy_pm, |
855 | }, |
856 | }; |
857 | |
858 | static int __init mxs_phy_module_init(void) |
859 | { |
860 | return platform_driver_register(&mxs_phy_driver); |
861 | } |
862 | postcore_initcall(mxs_phy_module_init); |
863 | |
864 | static void __exit mxs_phy_module_exit(void) |
865 | { |
866 | platform_driver_unregister(&mxs_phy_driver); |
867 | } |
868 | module_exit(mxs_phy_module_exit); |
869 | |
870 | MODULE_ALIAS("platform:mxs-usb-phy" ); |
871 | MODULE_AUTHOR("Marek Vasut <marex@denx.de>" ); |
872 | MODULE_AUTHOR("Richard Zhao <richard.zhao@freescale.com>" ); |
873 | MODULE_DESCRIPTION("Freescale MXS USB PHY driver" ); |
874 | MODULE_LICENSE("GPL" ); |
875 | |