1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * USB Glue for Amlogic G12A SoCs
4 *
5 * Copyright (c) 2019 BayLibre, SAS
6 * Author: Neil Armstrong <narmstrong@baylibre.com>
7 */
8
9 /*
10 * The USB is organized with a glue around the DWC3 Controller IP as :
11 * - Control registers for each USB2 Ports
12 * - Control registers for the USB PHY layer
13 * - SuperSpeed PHY can be enabled only if port is used
14 * - Dynamic OTG switching with ID change interrupt
15 */
16
17 #include <linux/module.h>
18 #include <linux/kernel.h>
19 #include <linux/platform_device.h>
20 #include <linux/clk.h>
21 #include <linux/of.h>
22 #include <linux/of_platform.h>
23 #include <linux/pm_runtime.h>
24 #include <linux/regmap.h>
25 #include <linux/bitfield.h>
26 #include <linux/bitops.h>
27 #include <linux/reset.h>
28 #include <linux/phy/phy.h>
29 #include <linux/usb/otg.h>
30 #include <linux/usb/role.h>
31 #include <linux/regulator/consumer.h>
32
33 /* USB2 Ports Control Registers, offsets are per-port */
34
35 #define U2P_REG_SIZE 0x20
36
37 #define U2P_R0 0x0
38 #define U2P_R0_HOST_DEVICE BIT(0)
39 #define U2P_R0_POWER_OK BIT(1)
40 #define U2P_R0_HAST_MODE BIT(2)
41 #define U2P_R0_POWER_ON_RESET BIT(3)
42 #define U2P_R0_ID_PULLUP BIT(4)
43 #define U2P_R0_DRV_VBUS BIT(5)
44
45 #define U2P_R1 0x4
46 #define U2P_R1_PHY_READY BIT(0)
47 #define U2P_R1_ID_DIG BIT(1)
48 #define U2P_R1_OTG_SESSION_VALID BIT(2)
49 #define U2P_R1_VBUS_VALID BIT(3)
50
51 /* USB Glue Control Registers */
52
53 #define G12A_GLUE_OFFSET 0x80
54
55 #define USB_R0 0x00
56 #define USB_R0_P30_LANE0_TX2RX_LOOPBACK BIT(17)
57 #define USB_R0_P30_LANE0_EXT_PCLK_REQ BIT(18)
58 #define USB_R0_P30_PCS_RX_LOS_MASK_VAL_MASK GENMASK(28, 19)
59 #define USB_R0_U2D_SS_SCALEDOWN_MODE_MASK GENMASK(30, 29)
60 #define USB_R0_U2D_ACT BIT(31)
61
62 #define USB_R1 0x04
63 #define USB_R1_U3H_BIGENDIAN_GS BIT(0)
64 #define USB_R1_U3H_PME_ENABLE BIT(1)
65 #define USB_R1_U3H_HUB_PORT_OVERCURRENT_MASK GENMASK(4, 2)
66 #define USB_R1_U3H_HUB_PORT_PERM_ATTACH_MASK GENMASK(9, 7)
67 #define USB_R1_U3H_HOST_U2_PORT_DISABLE_MASK GENMASK(13, 12)
68 #define USB_R1_U3H_HOST_U3_PORT_DISABLE BIT(16)
69 #define USB_R1_U3H_HOST_PORT_POWER_CONTROL_PRESENT BIT(17)
70 #define USB_R1_U3H_HOST_MSI_ENABLE BIT(18)
71 #define USB_R1_U3H_FLADJ_30MHZ_REG_MASK GENMASK(24, 19)
72 #define USB_R1_P30_PCS_TX_SWING_FULL_MASK GENMASK(31, 25)
73
74 #define USB_R2 0x08
75 #define USB_R2_P30_PCS_TX_DEEMPH_3P5DB_MASK GENMASK(25, 20)
76 #define USB_R2_P30_PCS_TX_DEEMPH_6DB_MASK GENMASK(31, 26)
77
78 #define USB_R3 0x0c
79 #define USB_R3_P30_SSC_ENABLE BIT(0)
80 #define USB_R3_P30_SSC_RANGE_MASK GENMASK(3, 1)
81 #define USB_R3_P30_SSC_REF_CLK_SEL_MASK GENMASK(12, 4)
82 #define USB_R3_P30_REF_SSP_EN BIT(13)
83
84 #define USB_R4 0x10
85 #define USB_R4_P21_PORT_RESET_0 BIT(0)
86 #define USB_R4_P21_SLEEP_M0 BIT(1)
87 #define USB_R4_MEM_PD_MASK GENMASK(3, 2)
88 #define USB_R4_P21_ONLY BIT(4)
89
90 #define USB_R5 0x14
91 #define USB_R5_ID_DIG_SYNC BIT(0)
92 #define USB_R5_ID_DIG_REG BIT(1)
93 #define USB_R5_ID_DIG_CFG_MASK GENMASK(3, 2)
94 #define USB_R5_ID_DIG_EN_0 BIT(4)
95 #define USB_R5_ID_DIG_EN_1 BIT(5)
96 #define USB_R5_ID_DIG_CURR BIT(6)
97 #define USB_R5_ID_DIG_IRQ BIT(7)
98 #define USB_R5_ID_DIG_TH_MASK GENMASK(15, 8)
99 #define USB_R5_ID_DIG_CNT_MASK GENMASK(23, 16)
100
101 #define PHY_COUNT 3
102 #define USB2_OTG_PHY 1
103
104 static struct clk_bulk_data meson_gxl_clocks[] = {
105 { .id = "usb_ctrl" },
106 { .id = "ddr" },
107 };
108
109 static struct clk_bulk_data meson_g12a_clocks[] = {
110 { .id = NULL },
111 };
112
113 static struct clk_bulk_data meson_a1_clocks[] = {
114 { .id = "usb_ctrl" },
115 { .id = "usb_bus" },
116 { .id = "xtal_usb_ctrl" },
117 };
118
119 static const char * const meson_gxm_phy_names[] = {
120 "usb2-phy0", "usb2-phy1", "usb2-phy2",
121 };
122
123 static const char * const meson_g12a_phy_names[] = {
124 "usb2-phy0", "usb2-phy1", "usb3-phy0",
125 };
126
127 /*
128 * Amlogic A1 has a single physical PHY, in slot 1, but still has the
129 * two U2 PHY controls register blocks like G12A.
130 * AXG has the similar scheme, thus needs the same tweak.
131 * Handling the first PHY on slot 1 would need a large amount of code
132 * changes, and the current management is generic enough to handle it
133 * correctly when only the "usb2-phy1" phy is specified on-par with the
134 * DT bindings.
135 */
136 static const char * const meson_a1_phy_names[] = {
137 "usb2-phy0", "usb2-phy1"
138 };
139
140 struct dwc3_meson_g12a;
141
142 struct dwc3_meson_g12a_drvdata {
143 bool otg_switch_supported;
144 bool otg_phy_host_port_disable;
145 struct clk_bulk_data *clks;
146 int num_clks;
147 const char * const *phy_names;
148 int num_phys;
149 int (*setup_regmaps)(struct dwc3_meson_g12a *priv, void __iomem *base);
150 int (*usb2_init_phy)(struct dwc3_meson_g12a *priv, int i,
151 enum phy_mode mode);
152 int (*set_phy_mode)(struct dwc3_meson_g12a *priv, int i,
153 enum phy_mode mode);
154 int (*usb_init)(struct dwc3_meson_g12a *priv);
155 int (*usb_post_init)(struct dwc3_meson_g12a *priv);
156 };
157
158 static int dwc3_meson_gxl_setup_regmaps(struct dwc3_meson_g12a *priv,
159 void __iomem *base);
160 static int dwc3_meson_g12a_setup_regmaps(struct dwc3_meson_g12a *priv,
161 void __iomem *base);
162
163 static int dwc3_meson_g12a_usb2_init_phy(struct dwc3_meson_g12a *priv, int i,
164 enum phy_mode mode);
165 static int dwc3_meson_gxl_usb2_init_phy(struct dwc3_meson_g12a *priv, int i,
166 enum phy_mode mode);
167
168 static int dwc3_meson_g12a_set_phy_mode(struct dwc3_meson_g12a *priv,
169 int i, enum phy_mode mode);
170 static int dwc3_meson_gxl_set_phy_mode(struct dwc3_meson_g12a *priv,
171 int i, enum phy_mode mode);
172
173 static int dwc3_meson_g12a_usb_init(struct dwc3_meson_g12a *priv);
174 static int dwc3_meson_gxl_usb_init(struct dwc3_meson_g12a *priv);
175
176 static int dwc3_meson_gxl_usb_post_init(struct dwc3_meson_g12a *priv);
177
178 /*
179 * For GXL and GXM SoCs:
180 * USB Phy muxing between the DWC2 Device controller and the DWC3 Host
181 * controller is buggy when switching from Device to Host when USB port
182 * is unpopulated, it causes the DWC3 to hard crash.
183 * When populated (including OTG switching with ID pin), the switch works
184 * like a charm like on the G12A platforms.
185 * In order to still switch from Host to Device on an USB Type-A port,
186 * an U2_PORT_DISABLE bit has been added to disconnect the DWC3 Host
187 * controller from the port, but when used the DWC3 controller must be
188 * reset to recover usage of the port.
189 */
190
191 static struct dwc3_meson_g12a_drvdata gxl_drvdata = {
192 .otg_switch_supported = true,
193 .otg_phy_host_port_disable = true,
194 .clks = meson_gxl_clocks,
195 .num_clks = ARRAY_SIZE(meson_g12a_clocks),
196 .phy_names = meson_a1_phy_names,
197 .num_phys = ARRAY_SIZE(meson_a1_phy_names),
198 .setup_regmaps = dwc3_meson_gxl_setup_regmaps,
199 .usb2_init_phy = dwc3_meson_gxl_usb2_init_phy,
200 .set_phy_mode = dwc3_meson_gxl_set_phy_mode,
201 .usb_init = dwc3_meson_gxl_usb_init,
202 .usb_post_init = dwc3_meson_gxl_usb_post_init,
203 };
204
205 static struct dwc3_meson_g12a_drvdata gxm_drvdata = {
206 .otg_switch_supported = true,
207 .otg_phy_host_port_disable = true,
208 .clks = meson_gxl_clocks,
209 .num_clks = ARRAY_SIZE(meson_g12a_clocks),
210 .phy_names = meson_gxm_phy_names,
211 .num_phys = ARRAY_SIZE(meson_gxm_phy_names),
212 .setup_regmaps = dwc3_meson_gxl_setup_regmaps,
213 .usb2_init_phy = dwc3_meson_gxl_usb2_init_phy,
214 .set_phy_mode = dwc3_meson_gxl_set_phy_mode,
215 .usb_init = dwc3_meson_gxl_usb_init,
216 .usb_post_init = dwc3_meson_gxl_usb_post_init,
217 };
218
219 static struct dwc3_meson_g12a_drvdata axg_drvdata = {
220 .otg_switch_supported = true,
221 .clks = meson_gxl_clocks,
222 .num_clks = ARRAY_SIZE(meson_gxl_clocks),
223 .phy_names = meson_a1_phy_names,
224 .num_phys = ARRAY_SIZE(meson_a1_phy_names),
225 .setup_regmaps = dwc3_meson_gxl_setup_regmaps,
226 .usb2_init_phy = dwc3_meson_gxl_usb2_init_phy,
227 .set_phy_mode = dwc3_meson_gxl_set_phy_mode,
228 .usb_init = dwc3_meson_g12a_usb_init,
229 .usb_post_init = dwc3_meson_gxl_usb_post_init,
230 };
231
232 static struct dwc3_meson_g12a_drvdata g12a_drvdata = {
233 .otg_switch_supported = true,
234 .clks = meson_g12a_clocks,
235 .num_clks = ARRAY_SIZE(meson_g12a_clocks),
236 .phy_names = meson_g12a_phy_names,
237 .num_phys = ARRAY_SIZE(meson_g12a_phy_names),
238 .setup_regmaps = dwc3_meson_g12a_setup_regmaps,
239 .usb2_init_phy = dwc3_meson_g12a_usb2_init_phy,
240 .set_phy_mode = dwc3_meson_g12a_set_phy_mode,
241 .usb_init = dwc3_meson_g12a_usb_init,
242 };
243
244 static struct dwc3_meson_g12a_drvdata a1_drvdata = {
245 .otg_switch_supported = false,
246 .clks = meson_a1_clocks,
247 .num_clks = ARRAY_SIZE(meson_a1_clocks),
248 .phy_names = meson_a1_phy_names,
249 .num_phys = ARRAY_SIZE(meson_a1_phy_names),
250 .setup_regmaps = dwc3_meson_g12a_setup_regmaps,
251 .usb2_init_phy = dwc3_meson_g12a_usb2_init_phy,
252 .set_phy_mode = dwc3_meson_g12a_set_phy_mode,
253 .usb_init = dwc3_meson_g12a_usb_init,
254 };
255
256 struct dwc3_meson_g12a {
257 struct device *dev;
258 struct regmap *u2p_regmap[PHY_COUNT];
259 struct regmap *usb_glue_regmap;
260 struct reset_control *reset;
261 struct phy *phys[PHY_COUNT];
262 enum usb_dr_mode otg_mode;
263 enum phy_mode otg_phy_mode;
264 unsigned int usb2_ports;
265 unsigned int usb3_ports;
266 struct regulator *vbus;
267 struct usb_role_switch_desc switch_desc;
268 struct usb_role_switch *role_switch;
269 const struct dwc3_meson_g12a_drvdata *drvdata;
270 };
271
dwc3_meson_gxl_set_phy_mode(struct dwc3_meson_g12a * priv,int i,enum phy_mode mode)272 static int dwc3_meson_gxl_set_phy_mode(struct dwc3_meson_g12a *priv,
273 int i, enum phy_mode mode)
274 {
275 return phy_set_mode(priv->phys[i], mode);
276 }
277
dwc3_meson_gxl_usb2_init_phy(struct dwc3_meson_g12a * priv,int i,enum phy_mode mode)278 static int dwc3_meson_gxl_usb2_init_phy(struct dwc3_meson_g12a *priv, int i,
279 enum phy_mode mode)
280 {
281 /* On GXL PHY must be started in device mode for DWC2 init */
282 return priv->drvdata->set_phy_mode(priv, i,
283 (i == USB2_OTG_PHY) ? PHY_MODE_USB_DEVICE
284 : PHY_MODE_USB_HOST);
285 }
286
dwc3_meson_g12a_set_phy_mode(struct dwc3_meson_g12a * priv,int i,enum phy_mode mode)287 static int dwc3_meson_g12a_set_phy_mode(struct dwc3_meson_g12a *priv,
288 int i, enum phy_mode mode)
289 {
290 if (mode == PHY_MODE_USB_HOST)
291 regmap_update_bits(priv->u2p_regmap[i], U2P_R0,
292 U2P_R0_HOST_DEVICE,
293 U2P_R0_HOST_DEVICE);
294 else
295 regmap_update_bits(priv->u2p_regmap[i], U2P_R0,
296 U2P_R0_HOST_DEVICE, 0);
297
298 return 0;
299 }
300
dwc3_meson_g12a_usb2_init_phy(struct dwc3_meson_g12a * priv,int i,enum phy_mode mode)301 static int dwc3_meson_g12a_usb2_init_phy(struct dwc3_meson_g12a *priv, int i,
302 enum phy_mode mode)
303 {
304 int ret;
305
306 regmap_update_bits(priv->u2p_regmap[i], U2P_R0,
307 U2P_R0_POWER_ON_RESET,
308 U2P_R0_POWER_ON_RESET);
309
310 if (priv->drvdata->otg_switch_supported && i == USB2_OTG_PHY) {
311 regmap_update_bits(priv->u2p_regmap[i], U2P_R0,
312 U2P_R0_ID_PULLUP | U2P_R0_DRV_VBUS,
313 U2P_R0_ID_PULLUP | U2P_R0_DRV_VBUS);
314
315 ret = priv->drvdata->set_phy_mode(priv, i, mode);
316 } else
317 ret = priv->drvdata->set_phy_mode(priv, i,
318 PHY_MODE_USB_HOST);
319
320 if (ret)
321 return ret;
322
323 regmap_update_bits(priv->u2p_regmap[i], U2P_R0,
324 U2P_R0_POWER_ON_RESET, 0);
325
326 return 0;
327 }
328
dwc3_meson_g12a_usb2_init(struct dwc3_meson_g12a * priv,enum phy_mode mode)329 static int dwc3_meson_g12a_usb2_init(struct dwc3_meson_g12a *priv,
330 enum phy_mode mode)
331 {
332 int i, ret;
333
334 for (i = 0; i < priv->drvdata->num_phys; ++i) {
335 if (!priv->phys[i])
336 continue;
337
338 if (!strstr(priv->drvdata->phy_names[i], "usb2"))
339 continue;
340
341 ret = priv->drvdata->usb2_init_phy(priv, i, mode);
342 if (ret)
343 return ret;
344 }
345
346 return 0;
347 }
348
dwc3_meson_g12a_usb3_init(struct dwc3_meson_g12a * priv)349 static void dwc3_meson_g12a_usb3_init(struct dwc3_meson_g12a *priv)
350 {
351 regmap_update_bits(priv->usb_glue_regmap, USB_R3,
352 USB_R3_P30_SSC_RANGE_MASK |
353 USB_R3_P30_REF_SSP_EN,
354 USB_R3_P30_SSC_ENABLE |
355 FIELD_PREP(USB_R3_P30_SSC_RANGE_MASK, 2) |
356 USB_R3_P30_REF_SSP_EN);
357 udelay(2);
358
359 regmap_update_bits(priv->usb_glue_regmap, USB_R2,
360 USB_R2_P30_PCS_TX_DEEMPH_3P5DB_MASK,
361 FIELD_PREP(USB_R2_P30_PCS_TX_DEEMPH_3P5DB_MASK, 0x15));
362
363 regmap_update_bits(priv->usb_glue_regmap, USB_R2,
364 USB_R2_P30_PCS_TX_DEEMPH_6DB_MASK,
365 FIELD_PREP(USB_R2_P30_PCS_TX_DEEMPH_6DB_MASK, 0x20));
366
367 udelay(2);
368
369 regmap_update_bits(priv->usb_glue_regmap, USB_R1,
370 USB_R1_U3H_HOST_PORT_POWER_CONTROL_PRESENT,
371 USB_R1_U3H_HOST_PORT_POWER_CONTROL_PRESENT);
372
373 regmap_update_bits(priv->usb_glue_regmap, USB_R1,
374 USB_R1_P30_PCS_TX_SWING_FULL_MASK,
375 FIELD_PREP(USB_R1_P30_PCS_TX_SWING_FULL_MASK, 127));
376 }
377
dwc3_meson_g12a_usb_otg_apply_mode(struct dwc3_meson_g12a * priv,enum phy_mode mode)378 static void dwc3_meson_g12a_usb_otg_apply_mode(struct dwc3_meson_g12a *priv,
379 enum phy_mode mode)
380 {
381 if (mode == PHY_MODE_USB_DEVICE) {
382 if (priv->otg_mode != USB_DR_MODE_OTG &&
383 priv->drvdata->otg_phy_host_port_disable)
384 /* Isolate the OTG PHY port from the Host Controller */
385 regmap_update_bits(priv->usb_glue_regmap, USB_R1,
386 USB_R1_U3H_HOST_U2_PORT_DISABLE_MASK,
387 FIELD_PREP(USB_R1_U3H_HOST_U2_PORT_DISABLE_MASK,
388 BIT(USB2_OTG_PHY)));
389
390 regmap_update_bits(priv->usb_glue_regmap, USB_R0,
391 USB_R0_U2D_ACT, USB_R0_U2D_ACT);
392 regmap_update_bits(priv->usb_glue_regmap, USB_R0,
393 USB_R0_U2D_SS_SCALEDOWN_MODE_MASK, 0);
394 regmap_update_bits(priv->usb_glue_regmap, USB_R4,
395 USB_R4_P21_SLEEP_M0, USB_R4_P21_SLEEP_M0);
396 } else {
397 if (priv->otg_mode != USB_DR_MODE_OTG &&
398 priv->drvdata->otg_phy_host_port_disable) {
399 regmap_update_bits(priv->usb_glue_regmap, USB_R1,
400 USB_R1_U3H_HOST_U2_PORT_DISABLE_MASK, 0);
401 msleep(500);
402 }
403 regmap_update_bits(priv->usb_glue_regmap, USB_R0,
404 USB_R0_U2D_ACT, 0);
405 regmap_update_bits(priv->usb_glue_regmap, USB_R4,
406 USB_R4_P21_SLEEP_M0, 0);
407 }
408 }
409
dwc3_meson_g12a_usb_init_glue(struct dwc3_meson_g12a * priv,enum phy_mode mode)410 static int dwc3_meson_g12a_usb_init_glue(struct dwc3_meson_g12a *priv,
411 enum phy_mode mode)
412 {
413 int ret;
414
415 ret = dwc3_meson_g12a_usb2_init(priv, mode);
416 if (ret)
417 return ret;
418
419 regmap_update_bits(priv->usb_glue_regmap, USB_R1,
420 USB_R1_U3H_FLADJ_30MHZ_REG_MASK,
421 FIELD_PREP(USB_R1_U3H_FLADJ_30MHZ_REG_MASK, 0x20));
422
423 regmap_update_bits(priv->usb_glue_regmap, USB_R5,
424 USB_R5_ID_DIG_EN_0,
425 USB_R5_ID_DIG_EN_0);
426 regmap_update_bits(priv->usb_glue_regmap, USB_R5,
427 USB_R5_ID_DIG_EN_1,
428 USB_R5_ID_DIG_EN_1);
429 regmap_update_bits(priv->usb_glue_regmap, USB_R5,
430 USB_R5_ID_DIG_TH_MASK,
431 FIELD_PREP(USB_R5_ID_DIG_TH_MASK, 0xff));
432
433 /* If we have an actual SuperSpeed port, initialize it */
434 if (priv->usb3_ports)
435 dwc3_meson_g12a_usb3_init(priv);
436
437 dwc3_meson_g12a_usb_otg_apply_mode(priv, mode);
438
439 return 0;
440 }
441
442 static const struct regmap_config phy_meson_g12a_usb_glue_regmap_conf = {
443 .name = "usb-glue",
444 .reg_bits = 8,
445 .val_bits = 32,
446 .reg_stride = 4,
447 .max_register = USB_R5,
448 };
449
dwc3_meson_g12a_get_phys(struct dwc3_meson_g12a * priv)450 static int dwc3_meson_g12a_get_phys(struct dwc3_meson_g12a *priv)
451 {
452 const char *phy_name;
453 int i;
454
455 for (i = 0 ; i < priv->drvdata->num_phys ; ++i) {
456 phy_name = priv->drvdata->phy_names[i];
457 priv->phys[i] = devm_phy_optional_get(priv->dev, phy_name);
458 if (!priv->phys[i])
459 continue;
460
461 if (IS_ERR(priv->phys[i]))
462 return PTR_ERR(priv->phys[i]);
463
464 if (strstr(phy_name, "usb3"))
465 priv->usb3_ports++;
466 else
467 priv->usb2_ports++;
468 }
469
470 dev_info(priv->dev, "USB2 ports: %d\n", priv->usb2_ports);
471 dev_info(priv->dev, "USB3 ports: %d\n", priv->usb3_ports);
472
473 return 0;
474 }
475
dwc3_meson_g12a_get_id(struct dwc3_meson_g12a * priv)476 static enum phy_mode dwc3_meson_g12a_get_id(struct dwc3_meson_g12a *priv)
477 {
478 u32 reg;
479
480 regmap_read(priv->usb_glue_regmap, USB_R5, ®);
481
482 if (reg & (USB_R5_ID_DIG_SYNC | USB_R5_ID_DIG_REG))
483 return PHY_MODE_USB_DEVICE;
484
485 return PHY_MODE_USB_HOST;
486 }
487
dwc3_meson_g12a_otg_mode_set(struct dwc3_meson_g12a * priv,enum phy_mode mode)488 static int dwc3_meson_g12a_otg_mode_set(struct dwc3_meson_g12a *priv,
489 enum phy_mode mode)
490 {
491 int ret;
492
493 if (!priv->drvdata->otg_switch_supported || !priv->phys[USB2_OTG_PHY])
494 return -EINVAL;
495
496 if (mode == PHY_MODE_USB_HOST)
497 dev_info(priv->dev, "switching to Host Mode\n");
498 else
499 dev_info(priv->dev, "switching to Device Mode\n");
500
501 if (priv->vbus) {
502 if (mode == PHY_MODE_USB_DEVICE)
503 ret = regulator_disable(priv->vbus);
504 else
505 ret = regulator_enable(priv->vbus);
506 if (ret)
507 return ret;
508 }
509
510 priv->otg_phy_mode = mode;
511
512 ret = priv->drvdata->set_phy_mode(priv, USB2_OTG_PHY, mode);
513 if (ret)
514 return ret;
515
516 dwc3_meson_g12a_usb_otg_apply_mode(priv, mode);
517
518 return 0;
519 }
520
dwc3_meson_g12a_role_set(struct usb_role_switch * sw,enum usb_role role)521 static int dwc3_meson_g12a_role_set(struct usb_role_switch *sw,
522 enum usb_role role)
523 {
524 struct dwc3_meson_g12a *priv = usb_role_switch_get_drvdata(sw);
525 enum phy_mode mode;
526
527 if (role == USB_ROLE_NONE)
528 return 0;
529
530 mode = (role == USB_ROLE_HOST) ? PHY_MODE_USB_HOST
531 : PHY_MODE_USB_DEVICE;
532
533 if (mode == priv->otg_phy_mode)
534 return 0;
535
536 if (priv->drvdata->otg_phy_host_port_disable)
537 dev_warn_once(priv->dev, "Broken manual OTG switch\n");
538
539 return dwc3_meson_g12a_otg_mode_set(priv, mode);
540 }
541
dwc3_meson_g12a_role_get(struct usb_role_switch * sw)542 static enum usb_role dwc3_meson_g12a_role_get(struct usb_role_switch *sw)
543 {
544 struct dwc3_meson_g12a *priv = usb_role_switch_get_drvdata(sw);
545
546 return priv->otg_phy_mode == PHY_MODE_USB_HOST ?
547 USB_ROLE_HOST : USB_ROLE_DEVICE;
548 }
549
dwc3_meson_g12a_irq_thread(int irq,void * data)550 static irqreturn_t dwc3_meson_g12a_irq_thread(int irq, void *data)
551 {
552 struct dwc3_meson_g12a *priv = data;
553 enum phy_mode otg_id;
554
555 otg_id = dwc3_meson_g12a_get_id(priv);
556 if (otg_id != priv->otg_phy_mode) {
557 if (dwc3_meson_g12a_otg_mode_set(priv, otg_id))
558 dev_warn(priv->dev, "Failed to switch OTG mode\n");
559 }
560
561 regmap_update_bits(priv->usb_glue_regmap, USB_R5,
562 USB_R5_ID_DIG_IRQ, 0);
563
564 return IRQ_HANDLED;
565 }
566
dwc3_meson_g12_find_child(struct device * dev,const char * compatible)567 static struct device *dwc3_meson_g12_find_child(struct device *dev,
568 const char *compatible)
569 {
570 struct platform_device *pdev;
571 struct device_node *np;
572
573 np = of_get_compatible_child(dev->of_node, compatible);
574 if (!np)
575 return NULL;
576
577 pdev = of_find_device_by_node(np);
578 of_node_put(np);
579 if (!pdev)
580 return NULL;
581
582 return &pdev->dev;
583 }
584
dwc3_meson_g12a_otg_init(struct platform_device * pdev,struct dwc3_meson_g12a * priv)585 static int dwc3_meson_g12a_otg_init(struct platform_device *pdev,
586 struct dwc3_meson_g12a *priv)
587 {
588 enum phy_mode otg_id;
589 int ret, irq;
590 struct device *dev = &pdev->dev;
591
592 if (!priv->drvdata->otg_switch_supported)
593 return 0;
594
595 if (priv->otg_mode == USB_DR_MODE_OTG) {
596 /* Ack irq before registering */
597 regmap_update_bits(priv->usb_glue_regmap, USB_R5,
598 USB_R5_ID_DIG_IRQ, 0);
599
600 irq = platform_get_irq(pdev, 0);
601 if (irq < 0)
602 return irq;
603 ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
604 dwc3_meson_g12a_irq_thread,
605 IRQF_ONESHOT, pdev->name, priv);
606 if (ret)
607 return ret;
608 }
609
610 /* Setup OTG mode corresponding to the ID pin */
611 if (priv->otg_mode == USB_DR_MODE_OTG) {
612 otg_id = dwc3_meson_g12a_get_id(priv);
613 if (otg_id != priv->otg_phy_mode) {
614 if (dwc3_meson_g12a_otg_mode_set(priv, otg_id))
615 dev_warn(dev, "Failed to switch OTG mode\n");
616 }
617 }
618
619 /* Setup role switcher */
620 priv->switch_desc.usb2_port = dwc3_meson_g12_find_child(dev,
621 "snps,dwc3");
622 priv->switch_desc.udc = dwc3_meson_g12_find_child(dev, "snps,dwc2");
623 priv->switch_desc.allow_userspace_control = true;
624 priv->switch_desc.set = dwc3_meson_g12a_role_set;
625 priv->switch_desc.get = dwc3_meson_g12a_role_get;
626 priv->switch_desc.driver_data = priv;
627
628 priv->role_switch = usb_role_switch_register(dev, &priv->switch_desc);
629 if (IS_ERR(priv->role_switch))
630 dev_warn(dev, "Unable to register Role Switch\n");
631
632 return 0;
633 }
634
dwc3_meson_gxl_setup_regmaps(struct dwc3_meson_g12a * priv,void __iomem * base)635 static int dwc3_meson_gxl_setup_regmaps(struct dwc3_meson_g12a *priv,
636 void __iomem *base)
637 {
638 /* GXL controls the PHY mode in the PHY registers unlike G12A */
639 priv->usb_glue_regmap = devm_regmap_init_mmio(priv->dev, base,
640 &phy_meson_g12a_usb_glue_regmap_conf);
641 return PTR_ERR_OR_ZERO(priv->usb_glue_regmap);
642 }
643
dwc3_meson_g12a_setup_regmaps(struct dwc3_meson_g12a * priv,void __iomem * base)644 static int dwc3_meson_g12a_setup_regmaps(struct dwc3_meson_g12a *priv,
645 void __iomem *base)
646 {
647 int i;
648
649 priv->usb_glue_regmap = devm_regmap_init_mmio(priv->dev,
650 base + G12A_GLUE_OFFSET,
651 &phy_meson_g12a_usb_glue_regmap_conf);
652 if (IS_ERR(priv->usb_glue_regmap))
653 return PTR_ERR(priv->usb_glue_regmap);
654
655 /* Create a regmap for each USB2 PHY control register set */
656 for (i = 0; i < priv->drvdata->num_phys; i++) {
657 struct regmap_config u2p_regmap_config = {
658 .reg_bits = 8,
659 .val_bits = 32,
660 .reg_stride = 4,
661 .max_register = U2P_R1,
662 };
663
664 if (!strstr(priv->drvdata->phy_names[i], "usb2"))
665 continue;
666
667 u2p_regmap_config.name = devm_kasprintf(priv->dev, GFP_KERNEL,
668 "u2p-%d", i);
669 if (!u2p_regmap_config.name)
670 return -ENOMEM;
671
672 priv->u2p_regmap[i] = devm_regmap_init_mmio(priv->dev,
673 base + (i * U2P_REG_SIZE),
674 &u2p_regmap_config);
675 if (IS_ERR(priv->u2p_regmap[i]))
676 return PTR_ERR(priv->u2p_regmap[i]);
677 }
678
679 return 0;
680 }
681
dwc3_meson_g12a_usb_init(struct dwc3_meson_g12a * priv)682 static int dwc3_meson_g12a_usb_init(struct dwc3_meson_g12a *priv)
683 {
684 return dwc3_meson_g12a_usb_init_glue(priv, priv->otg_phy_mode);
685 }
686
dwc3_meson_gxl_usb_init(struct dwc3_meson_g12a * priv)687 static int dwc3_meson_gxl_usb_init(struct dwc3_meson_g12a *priv)
688 {
689 return dwc3_meson_g12a_usb_init_glue(priv, PHY_MODE_USB_DEVICE);
690 }
691
dwc3_meson_gxl_usb_post_init(struct dwc3_meson_g12a * priv)692 static int dwc3_meson_gxl_usb_post_init(struct dwc3_meson_g12a *priv)
693 {
694 int ret;
695
696 ret = priv->drvdata->set_phy_mode(priv, USB2_OTG_PHY,
697 priv->otg_phy_mode);
698 if (ret)
699 return ret;
700
701 dwc3_meson_g12a_usb_otg_apply_mode(priv, priv->otg_phy_mode);
702
703 return 0;
704 }
705
dwc3_meson_g12a_probe(struct platform_device * pdev)706 static int dwc3_meson_g12a_probe(struct platform_device *pdev)
707 {
708 struct dwc3_meson_g12a *priv;
709 struct device *dev = &pdev->dev;
710 struct device_node *np = dev->of_node;
711 void __iomem *base;
712 int ret, i;
713
714 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
715 if (!priv)
716 return -ENOMEM;
717
718 base = devm_platform_ioremap_resource(pdev, 0);
719 if (IS_ERR(base))
720 return PTR_ERR(base);
721
722 priv->drvdata = of_device_get_match_data(&pdev->dev);
723 priv->dev = dev;
724
725 priv->vbus = devm_regulator_get_optional(dev, "vbus");
726 if (IS_ERR(priv->vbus)) {
727 if (PTR_ERR(priv->vbus) == -EPROBE_DEFER)
728 return PTR_ERR(priv->vbus);
729 priv->vbus = NULL;
730 }
731
732 ret = devm_clk_bulk_get(dev,
733 priv->drvdata->num_clks,
734 priv->drvdata->clks);
735 if (ret)
736 return ret;
737
738 ret = clk_bulk_prepare_enable(priv->drvdata->num_clks,
739 priv->drvdata->clks);
740 if (ret)
741 return ret;
742
743 platform_set_drvdata(pdev, priv);
744
745 priv->reset = devm_reset_control_get_shared(dev, NULL);
746 if (IS_ERR(priv->reset)) {
747 ret = PTR_ERR(priv->reset);
748 dev_err(dev, "failed to get device reset, err=%d\n", ret);
749 goto err_disable_clks;
750 }
751
752 ret = reset_control_reset(priv->reset);
753 if (ret)
754 goto err_disable_clks;
755
756 ret = dwc3_meson_g12a_get_phys(priv);
757 if (ret)
758 goto err_disable_clks;
759
760 ret = priv->drvdata->setup_regmaps(priv, base);
761 if (ret)
762 goto err_disable_clks;
763
764 if (priv->vbus) {
765 ret = regulator_enable(priv->vbus);
766 if (ret)
767 goto err_disable_clks;
768 }
769
770 /* Get dr_mode */
771 priv->otg_mode = usb_get_dr_mode(dev);
772
773 if (priv->otg_mode == USB_DR_MODE_PERIPHERAL)
774 priv->otg_phy_mode = PHY_MODE_USB_DEVICE;
775 else
776 priv->otg_phy_mode = PHY_MODE_USB_HOST;
777
778 ret = priv->drvdata->usb_init(priv);
779 if (ret)
780 goto err_disable_regulator;
781
782 /* Init PHYs */
783 for (i = 0 ; i < PHY_COUNT ; ++i) {
784 ret = phy_init(priv->phys[i]);
785 if (ret)
786 goto err_disable_regulator;
787 }
788
789 /* Set PHY Power */
790 for (i = 0 ; i < PHY_COUNT ; ++i) {
791 ret = phy_power_on(priv->phys[i]);
792 if (ret)
793 goto err_phys_exit;
794 }
795
796 if (priv->drvdata->usb_post_init) {
797 ret = priv->drvdata->usb_post_init(priv);
798 if (ret)
799 goto err_phys_power;
800 }
801
802 ret = of_platform_populate(np, NULL, NULL, dev);
803 if (ret)
804 goto err_phys_power;
805
806 ret = dwc3_meson_g12a_otg_init(pdev, priv);
807 if (ret)
808 goto err_phys_power;
809
810 pm_runtime_set_active(dev);
811 pm_runtime_enable(dev);
812 pm_runtime_get_sync(dev);
813
814 return 0;
815
816 err_phys_power:
817 for (i = 0 ; i < PHY_COUNT ; ++i)
818 phy_power_off(priv->phys[i]);
819
820 err_phys_exit:
821 for (i = 0 ; i < PHY_COUNT ; ++i)
822 phy_exit(priv->phys[i]);
823
824 err_disable_regulator:
825 if (priv->vbus)
826 regulator_disable(priv->vbus);
827
828 err_disable_clks:
829 clk_bulk_disable_unprepare(priv->drvdata->num_clks,
830 priv->drvdata->clks);
831
832 return ret;
833 }
834
dwc3_meson_g12a_remove(struct platform_device * pdev)835 static int dwc3_meson_g12a_remove(struct platform_device *pdev)
836 {
837 struct dwc3_meson_g12a *priv = platform_get_drvdata(pdev);
838 struct device *dev = &pdev->dev;
839 int i;
840
841 if (priv->drvdata->otg_switch_supported)
842 usb_role_switch_unregister(priv->role_switch);
843
844 of_platform_depopulate(dev);
845
846 for (i = 0 ; i < PHY_COUNT ; ++i) {
847 phy_power_off(priv->phys[i]);
848 phy_exit(priv->phys[i]);
849 }
850
851 pm_runtime_disable(dev);
852 pm_runtime_put_noidle(dev);
853 pm_runtime_set_suspended(dev);
854
855 clk_bulk_disable_unprepare(priv->drvdata->num_clks,
856 priv->drvdata->clks);
857
858 return 0;
859 }
860
dwc3_meson_g12a_runtime_suspend(struct device * dev)861 static int __maybe_unused dwc3_meson_g12a_runtime_suspend(struct device *dev)
862 {
863 struct dwc3_meson_g12a *priv = dev_get_drvdata(dev);
864
865 clk_bulk_disable_unprepare(priv->drvdata->num_clks,
866 priv->drvdata->clks);
867
868 return 0;
869 }
870
dwc3_meson_g12a_runtime_resume(struct device * dev)871 static int __maybe_unused dwc3_meson_g12a_runtime_resume(struct device *dev)
872 {
873 struct dwc3_meson_g12a *priv = dev_get_drvdata(dev);
874
875 return clk_bulk_prepare_enable(priv->drvdata->num_clks,
876 priv->drvdata->clks);
877 }
878
dwc3_meson_g12a_suspend(struct device * dev)879 static int __maybe_unused dwc3_meson_g12a_suspend(struct device *dev)
880 {
881 struct dwc3_meson_g12a *priv = dev_get_drvdata(dev);
882 int i, ret;
883
884 if (priv->vbus && priv->otg_phy_mode == PHY_MODE_USB_HOST) {
885 ret = regulator_disable(priv->vbus);
886 if (ret)
887 return ret;
888 }
889
890 for (i = 0 ; i < PHY_COUNT ; ++i) {
891 phy_power_off(priv->phys[i]);
892 phy_exit(priv->phys[i]);
893 }
894
895 reset_control_assert(priv->reset);
896
897 return 0;
898 }
899
dwc3_meson_g12a_resume(struct device * dev)900 static int __maybe_unused dwc3_meson_g12a_resume(struct device *dev)
901 {
902 struct dwc3_meson_g12a *priv = dev_get_drvdata(dev);
903 int i, ret;
904
905 reset_control_deassert(priv->reset);
906
907 ret = priv->drvdata->usb_init(priv);
908 if (ret)
909 return ret;
910
911 /* Init PHYs */
912 for (i = 0 ; i < PHY_COUNT ; ++i) {
913 ret = phy_init(priv->phys[i]);
914 if (ret)
915 return ret;
916 }
917
918 /* Set PHY Power */
919 for (i = 0 ; i < PHY_COUNT ; ++i) {
920 ret = phy_power_on(priv->phys[i]);
921 if (ret)
922 return ret;
923 }
924
925 if (priv->vbus && priv->otg_phy_mode == PHY_MODE_USB_HOST) {
926 ret = regulator_enable(priv->vbus);
927 if (ret)
928 return ret;
929 }
930
931 return 0;
932 }
933
934 static const struct dev_pm_ops dwc3_meson_g12a_dev_pm_ops = {
935 SET_SYSTEM_SLEEP_PM_OPS(dwc3_meson_g12a_suspend, dwc3_meson_g12a_resume)
936 SET_RUNTIME_PM_OPS(dwc3_meson_g12a_runtime_suspend,
937 dwc3_meson_g12a_runtime_resume, NULL)
938 };
939
940 static const struct of_device_id dwc3_meson_g12a_match[] = {
941 {
942 .compatible = "amlogic,meson-gxl-usb-ctrl",
943 .data = &gxl_drvdata,
944 },
945 {
946 .compatible = "amlogic,meson-gxm-usb-ctrl",
947 .data = &gxm_drvdata,
948 },
949 {
950 .compatible = "amlogic,meson-axg-usb-ctrl",
951 .data = &axg_drvdata,
952 },
953 {
954 .compatible = "amlogic,meson-g12a-usb-ctrl",
955 .data = &g12a_drvdata,
956 },
957 {
958 .compatible = "amlogic,meson-a1-usb-ctrl",
959 .data = &a1_drvdata,
960 },
961 { /* Sentinel */ }
962 };
963 MODULE_DEVICE_TABLE(of, dwc3_meson_g12a_match);
964
965 static struct platform_driver dwc3_meson_g12a_driver = {
966 .probe = dwc3_meson_g12a_probe,
967 .remove = dwc3_meson_g12a_remove,
968 .driver = {
969 .name = "dwc3-meson-g12a",
970 .of_match_table = dwc3_meson_g12a_match,
971 .pm = &dwc3_meson_g12a_dev_pm_ops,
972 },
973 };
974
975 module_platform_driver(dwc3_meson_g12a_driver);
976 MODULE_LICENSE("GPL v2");
977 MODULE_DESCRIPTION("Amlogic Meson G12A USB Glue Layer");
978 MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>");
979