Linux Audio

Check our new training course

Loading...
Note: File does not exist in v4.6.
  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
104static struct clk_bulk_data meson_gxl_clocks[] = {
105	{ .id = "usb_ctrl" },
106	{ .id = "ddr" },
107};
108
109static struct clk_bulk_data meson_g12a_clocks[] = {
110	{ .id = NULL },
111};
112
113static struct clk_bulk_data meson_a1_clocks[] = {
114	{ .id = "usb_ctrl" },
115	{ .id = "usb_bus" },
116	{ .id = "xtal_usb_ctrl" },
117};
118
119static const char * const meson_gxm_phy_names[] = {
120	"usb2-phy0", "usb2-phy1", "usb2-phy2",
121};
122
123static 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 */
136static const char * const meson_a1_phy_names[] = {
137	"usb2-phy0", "usb2-phy1"
138};
139
140struct dwc3_meson_g12a;
141
142struct 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
158static int dwc3_meson_gxl_setup_regmaps(struct dwc3_meson_g12a *priv,
159					void __iomem *base);
160static int dwc3_meson_g12a_setup_regmaps(struct dwc3_meson_g12a *priv,
161					 void __iomem *base);
162
163static int dwc3_meson_g12a_usb2_init_phy(struct dwc3_meson_g12a *priv, int i,
164					 enum phy_mode mode);
165static int dwc3_meson_gxl_usb2_init_phy(struct dwc3_meson_g12a *priv, int i,
166					enum phy_mode mode);
167
168static int dwc3_meson_g12a_set_phy_mode(struct dwc3_meson_g12a *priv,
169					int i, enum phy_mode mode);
170static int dwc3_meson_gxl_set_phy_mode(struct dwc3_meson_g12a *priv,
171				       int i, enum phy_mode mode);
172
173static int dwc3_meson_g12a_usb_init(struct dwc3_meson_g12a *priv);
174static int dwc3_meson_gxl_usb_init(struct dwc3_meson_g12a *priv);
175
176static 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
191static const 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
205static const 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
219static const 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
232static const 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
244static const 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
256struct 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
272static 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
278static 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
287static 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
301static 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
329static 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
349static 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
378static 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
410static 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
442static 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
450static 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
476static 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, &reg);
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
488static 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
521static 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
542static 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
550static 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
567static 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
585static 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
635static 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
644static 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
682static 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
687static 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
692static 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
706static 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_rearm;
759
760	ret = priv->drvdata->setup_regmaps(priv, base);
761	if (ret)
762		goto err_rearm;
763
764	if (priv->vbus) {
765		ret = regulator_enable(priv->vbus);
766		if (ret)
767			goto err_rearm;
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
816err_phys_power:
817	for (i = 0 ; i < PHY_COUNT ; ++i)
818		phy_power_off(priv->phys[i]);
819
820err_phys_exit:
821	for (i = 0 ; i < PHY_COUNT ; ++i)
822		phy_exit(priv->phys[i]);
823
824err_disable_regulator:
825	if (priv->vbus)
826		regulator_disable(priv->vbus);
827
828err_rearm:
829	reset_control_rearm(priv->reset);
830
831err_disable_clks:
832	clk_bulk_disable_unprepare(priv->drvdata->num_clks,
833				   priv->drvdata->clks);
834
835	return ret;
836}
837
838static int dwc3_meson_g12a_remove(struct platform_device *pdev)
839{
840	struct dwc3_meson_g12a *priv = platform_get_drvdata(pdev);
841	struct device *dev = &pdev->dev;
842	int i;
843
844	if (priv->drvdata->otg_switch_supported)
845		usb_role_switch_unregister(priv->role_switch);
846
847	of_platform_depopulate(dev);
848
849	for (i = 0 ; i < PHY_COUNT ; ++i) {
850		phy_power_off(priv->phys[i]);
851		phy_exit(priv->phys[i]);
852	}
853
854	pm_runtime_disable(dev);
855	pm_runtime_put_noidle(dev);
856	pm_runtime_set_suspended(dev);
857
858	reset_control_rearm(priv->reset);
859
860	clk_bulk_disable_unprepare(priv->drvdata->num_clks,
861				   priv->drvdata->clks);
862
863	return 0;
864}
865
866static int __maybe_unused dwc3_meson_g12a_runtime_suspend(struct device *dev)
867{
868	struct dwc3_meson_g12a	*priv = dev_get_drvdata(dev);
869
870	clk_bulk_disable_unprepare(priv->drvdata->num_clks,
871				   priv->drvdata->clks);
872
873	return 0;
874}
875
876static int __maybe_unused dwc3_meson_g12a_runtime_resume(struct device *dev)
877{
878	struct dwc3_meson_g12a	*priv = dev_get_drvdata(dev);
879
880	return clk_bulk_prepare_enable(priv->drvdata->num_clks,
881				       priv->drvdata->clks);
882}
883
884static int __maybe_unused dwc3_meson_g12a_suspend(struct device *dev)
885{
886	struct dwc3_meson_g12a *priv = dev_get_drvdata(dev);
887	int i, ret;
888
889	if (priv->vbus && priv->otg_phy_mode == PHY_MODE_USB_HOST) {
890		ret = regulator_disable(priv->vbus);
891		if (ret)
892			return ret;
893	}
894
895	for (i = 0 ; i < PHY_COUNT ; ++i) {
896		phy_power_off(priv->phys[i]);
897		phy_exit(priv->phys[i]);
898	}
899
900	reset_control_rearm(priv->reset);
901
902	return 0;
903}
904
905static int __maybe_unused dwc3_meson_g12a_resume(struct device *dev)
906{
907	struct dwc3_meson_g12a *priv = dev_get_drvdata(dev);
908	int i, ret;
909
910	ret = reset_control_reset(priv->reset);
911	if (ret)
912		return ret;
913
914	ret = priv->drvdata->usb_init(priv);
915	if (ret)
916		return ret;
917
918	/* Init PHYs */
919	for (i = 0 ; i < PHY_COUNT ; ++i) {
920		ret = phy_init(priv->phys[i]);
921		if (ret)
922			return ret;
923	}
924
925	/* Set PHY Power */
926	for (i = 0 ; i < PHY_COUNT ; ++i) {
927		ret = phy_power_on(priv->phys[i]);
928		if (ret)
929			return ret;
930	}
931
932	if (priv->vbus && priv->otg_phy_mode == PHY_MODE_USB_HOST) {
933		ret = regulator_enable(priv->vbus);
934		if (ret)
935			return ret;
936	}
937
938	return 0;
939}
940
941static const struct dev_pm_ops dwc3_meson_g12a_dev_pm_ops = {
942	SET_SYSTEM_SLEEP_PM_OPS(dwc3_meson_g12a_suspend, dwc3_meson_g12a_resume)
943	SET_RUNTIME_PM_OPS(dwc3_meson_g12a_runtime_suspend,
944			   dwc3_meson_g12a_runtime_resume, NULL)
945};
946
947static const struct of_device_id dwc3_meson_g12a_match[] = {
948	{
949		.compatible = "amlogic,meson-gxl-usb-ctrl",
950		.data = &gxl_drvdata,
951	},
952	{
953		.compatible = "amlogic,meson-gxm-usb-ctrl",
954		.data = &gxm_drvdata,
955	},
956	{
957		.compatible = "amlogic,meson-axg-usb-ctrl",
958		.data = &axg_drvdata,
959	},
960	{
961		.compatible = "amlogic,meson-g12a-usb-ctrl",
962		.data = &g12a_drvdata,
963	},
964	{
965		.compatible = "amlogic,meson-a1-usb-ctrl",
966		.data = &a1_drvdata,
967	},
968	{ /* Sentinel */ }
969};
970MODULE_DEVICE_TABLE(of, dwc3_meson_g12a_match);
971
972static struct platform_driver dwc3_meson_g12a_driver = {
973	.probe		= dwc3_meson_g12a_probe,
974	.remove		= dwc3_meson_g12a_remove,
975	.driver		= {
976		.name	= "dwc3-meson-g12a",
977		.of_match_table = dwc3_meson_g12a_match,
978		.pm	= &dwc3_meson_g12a_dev_pm_ops,
979	},
980};
981
982module_platform_driver(dwc3_meson_g12a_driver);
983MODULE_LICENSE("GPL v2");
984MODULE_DESCRIPTION("Amlogic Meson G12A USB Glue Layer");
985MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>");