• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * phy-brcm-usb.c - Broadcom USB Phy Driver
4  *
5  * Copyright (C) 2015-2017 Broadcom
6  */
7 
8 #include <linux/clk.h>
9 #include <linux/delay.h>
10 #include <linux/err.h>
11 #include <linux/io.h>
12 #include <linux/module.h>
13 #include <linux/of.h>
14 #include <linux/phy/phy.h>
15 #include <linux/platform_device.h>
16 #include <linux/interrupt.h>
17 #include <linux/soc/brcmstb/brcmstb.h>
18 #include <dt-bindings/phy/phy.h>
19 #include <linux/mfd/syscon.h>
20 #include <linux/suspend.h>
21 
22 #include "phy-brcm-usb-init.h"
23 
24 static DEFINE_MUTEX(sysfs_lock);
25 
26 enum brcm_usb_phy_id {
27 	BRCM_USB_PHY_2_0 = 0,
28 	BRCM_USB_PHY_3_0,
29 	BRCM_USB_PHY_ID_MAX
30 };
31 
32 struct value_to_name_map {
33 	int value;
34 	const char *name;
35 };
36 
37 struct match_chip_info {
38 	void *init_func;
39 	u8 required_regs[BRCM_REGS_MAX + 1];
40 	u8 optional_reg;
41 };
42 
43 static const struct value_to_name_map brcm_dr_mode_to_name[] = {
44 	{ USB_CTLR_MODE_HOST, "host" },
45 	{ USB_CTLR_MODE_DEVICE, "peripheral" },
46 	{ USB_CTLR_MODE_DRD, "drd" },
47 	{ USB_CTLR_MODE_TYPEC_PD, "typec-pd" }
48 };
49 
50 static const struct value_to_name_map brcm_dual_mode_to_name[] = {
51 	{ 0, "host" },
52 	{ 1, "device" },
53 	{ 2, "auto" },
54 };
55 
56 struct brcm_usb_phy {
57 	struct phy *phy;
58 	unsigned int id;
59 	bool inited;
60 };
61 
62 struct brcm_usb_phy_data {
63 	struct  brcm_usb_init_params ini;
64 	bool			has_eohci;
65 	bool			has_xhci;
66 	struct clk		*usb_20_clk;
67 	struct clk		*usb_30_clk;
68 	struct clk		*suspend_clk;
69 	struct mutex		mutex;	/* serialize phy init */
70 	int			init_count;
71 	int			wake_irq;
72 	struct brcm_usb_phy	phys[BRCM_USB_PHY_ID_MAX];
73 	struct notifier_block	pm_notifier;
74 	bool			pm_active;
75 };
76 
77 static s8 *node_reg_names[BRCM_REGS_MAX] = {
78 	"crtl", "xhci_ec", "xhci_gbl", "usb_phy", "usb_mdio", "bdc_ec"
79 };
80 
brcm_pm_notifier(struct notifier_block * notifier,unsigned long pm_event,void * unused)81 static int brcm_pm_notifier(struct notifier_block *notifier,
82 			    unsigned long pm_event,
83 			    void *unused)
84 {
85 	struct brcm_usb_phy_data *priv =
86 		container_of(notifier, struct brcm_usb_phy_data, pm_notifier);
87 
88 	switch (pm_event) {
89 	case PM_HIBERNATION_PREPARE:
90 	case PM_SUSPEND_PREPARE:
91 		priv->pm_active = true;
92 		break;
93 	case PM_POST_RESTORE:
94 	case PM_POST_HIBERNATION:
95 	case PM_POST_SUSPEND:
96 		priv->pm_active = false;
97 		break;
98 	}
99 	return NOTIFY_DONE;
100 }
101 
brcm_usb_phy_wake_isr(int irq,void * dev_id)102 static irqreturn_t brcm_usb_phy_wake_isr(int irq, void *dev_id)
103 {
104 	struct device *dev = dev_id;
105 
106 	pm_wakeup_event(dev, 0);
107 
108 	return IRQ_HANDLED;
109 }
110 
brcm_usb_phy_init(struct phy * gphy)111 static int brcm_usb_phy_init(struct phy *gphy)
112 {
113 	struct brcm_usb_phy *phy = phy_get_drvdata(gphy);
114 	struct brcm_usb_phy_data *priv =
115 		container_of(phy, struct brcm_usb_phy_data, phys[phy->id]);
116 
117 	if (priv->pm_active)
118 		return 0;
119 
120 	/*
121 	 * Use a lock to make sure a second caller waits until
122 	 * the base phy is inited before using it.
123 	 */
124 	mutex_lock(&priv->mutex);
125 	if (priv->init_count++ == 0) {
126 		clk_prepare_enable(priv->usb_20_clk);
127 		clk_prepare_enable(priv->usb_30_clk);
128 		clk_prepare_enable(priv->suspend_clk);
129 		brcm_usb_init_common(&priv->ini);
130 	}
131 	mutex_unlock(&priv->mutex);
132 	if (phy->id == BRCM_USB_PHY_2_0)
133 		brcm_usb_init_eohci(&priv->ini);
134 	else if (phy->id == BRCM_USB_PHY_3_0)
135 		brcm_usb_init_xhci(&priv->ini);
136 	phy->inited = true;
137 	dev_dbg(&gphy->dev, "INIT, id: %d, total: %d\n", phy->id,
138 		priv->init_count);
139 
140 	return 0;
141 }
142 
brcm_usb_phy_exit(struct phy * gphy)143 static int brcm_usb_phy_exit(struct phy *gphy)
144 {
145 	struct brcm_usb_phy *phy = phy_get_drvdata(gphy);
146 	struct brcm_usb_phy_data *priv =
147 		container_of(phy, struct brcm_usb_phy_data, phys[phy->id]);
148 
149 	if (priv->pm_active)
150 		return 0;
151 
152 	dev_dbg(&gphy->dev, "EXIT\n");
153 	if (phy->id == BRCM_USB_PHY_2_0)
154 		brcm_usb_uninit_eohci(&priv->ini);
155 	if (phy->id == BRCM_USB_PHY_3_0)
156 		brcm_usb_uninit_xhci(&priv->ini);
157 
158 	/* If both xhci and eohci are gone, reset everything else */
159 	mutex_lock(&priv->mutex);
160 	if (--priv->init_count == 0) {
161 		brcm_usb_uninit_common(&priv->ini);
162 		clk_disable_unprepare(priv->usb_20_clk);
163 		clk_disable_unprepare(priv->usb_30_clk);
164 		clk_disable_unprepare(priv->suspend_clk);
165 	}
166 	mutex_unlock(&priv->mutex);
167 	phy->inited = false;
168 	return 0;
169 }
170 
171 static const struct phy_ops brcm_usb_phy_ops = {
172 	.init		= brcm_usb_phy_init,
173 	.exit		= brcm_usb_phy_exit,
174 	.owner		= THIS_MODULE,
175 };
176 
brcm_usb_phy_xlate(struct device * dev,struct of_phandle_args * args)177 static struct phy *brcm_usb_phy_xlate(struct device *dev,
178 				      struct of_phandle_args *args)
179 {
180 	struct brcm_usb_phy_data *data = dev_get_drvdata(dev);
181 
182 	/*
183 	 * values 0 and 1 are for backward compatibility with
184 	 * device tree nodes from older bootloaders.
185 	 */
186 	switch (args->args[0]) {
187 	case 0:
188 	case PHY_TYPE_USB2:
189 		if (data->phys[BRCM_USB_PHY_2_0].phy)
190 			return data->phys[BRCM_USB_PHY_2_0].phy;
191 		dev_warn(dev, "Error, 2.0 Phy not found\n");
192 		break;
193 	case 1:
194 	case PHY_TYPE_USB3:
195 		if (data->phys[BRCM_USB_PHY_3_0].phy)
196 			return data->phys[BRCM_USB_PHY_3_0].phy;
197 		dev_warn(dev, "Error, 3.0 Phy not found\n");
198 		break;
199 	}
200 	return ERR_PTR(-ENODEV);
201 }
202 
name_to_value(const struct value_to_name_map * table,int count,const char * name,int * value)203 static int name_to_value(const struct value_to_name_map *table, int count,
204 			 const char *name, int *value)
205 {
206 	int x;
207 
208 	*value = 0;
209 	for (x = 0; x < count; x++) {
210 		if (sysfs_streq(name, table[x].name)) {
211 			*value = x;
212 			return 0;
213 		}
214 	}
215 	return -EINVAL;
216 }
217 
value_to_name(const struct value_to_name_map * table,int count,int value)218 static const char *value_to_name(const struct value_to_name_map *table, int count,
219 				 int value)
220 {
221 	if (value >= count)
222 		return "unknown";
223 	return table[value].name;
224 }
225 
dr_mode_show(struct device * dev,struct device_attribute * attr,char * buf)226 static ssize_t dr_mode_show(struct device *dev,
227 			    struct device_attribute *attr,
228 			    char *buf)
229 {
230 	struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);
231 
232 	return sprintf(buf, "%s\n",
233 		value_to_name(&brcm_dr_mode_to_name[0],
234 			      ARRAY_SIZE(brcm_dr_mode_to_name),
235 			      priv->ini.mode));
236 }
237 static DEVICE_ATTR_RO(dr_mode);
238 
dual_select_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t len)239 static ssize_t dual_select_store(struct device *dev,
240 				 struct device_attribute *attr,
241 				 const char *buf, size_t len)
242 {
243 	struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);
244 	int value;
245 	int res;
246 
247 	mutex_lock(&sysfs_lock);
248 	res = name_to_value(&brcm_dual_mode_to_name[0],
249 			    ARRAY_SIZE(brcm_dual_mode_to_name), buf, &value);
250 	if (!res) {
251 		brcm_usb_set_dual_select(&priv->ini, value);
252 		res = len;
253 	}
254 	mutex_unlock(&sysfs_lock);
255 	return res;
256 }
257 
dual_select_show(struct device * dev,struct device_attribute * attr,char * buf)258 static ssize_t dual_select_show(struct device *dev,
259 				struct device_attribute *attr,
260 				char *buf)
261 {
262 	struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);
263 	int value;
264 
265 	mutex_lock(&sysfs_lock);
266 	value = brcm_usb_get_dual_select(&priv->ini);
267 	mutex_unlock(&sysfs_lock);
268 	return sprintf(buf, "%s\n",
269 		value_to_name(&brcm_dual_mode_to_name[0],
270 			      ARRAY_SIZE(brcm_dual_mode_to_name),
271 			      value));
272 }
273 static DEVICE_ATTR_RW(dual_select);
274 
275 static struct attribute *brcm_usb_phy_attrs[] = {
276 	&dev_attr_dr_mode.attr,
277 	&dev_attr_dual_select.attr,
278 	NULL
279 };
280 
281 static const struct attribute_group brcm_usb_phy_group = {
282 	.attrs = brcm_usb_phy_attrs,
283 };
284 
285 static const struct match_chip_info chip_info_7216 = {
286 	.init_func = &brcm_usb_dvr_init_7216,
287 	.required_regs = {
288 		BRCM_REGS_CTRL,
289 		BRCM_REGS_XHCI_EC,
290 		BRCM_REGS_XHCI_GBL,
291 		-1,
292 	},
293 };
294 
295 static const struct match_chip_info chip_info_7211b0 = {
296 	.init_func = &brcm_usb_dvr_init_7211b0,
297 	.required_regs = {
298 		BRCM_REGS_CTRL,
299 		BRCM_REGS_XHCI_EC,
300 		BRCM_REGS_XHCI_GBL,
301 		BRCM_REGS_USB_PHY,
302 		BRCM_REGS_USB_MDIO,
303 		-1,
304 	},
305 	.optional_reg = BRCM_REGS_BDC_EC,
306 };
307 
308 static const struct match_chip_info chip_info_7445 = {
309 	.init_func = &brcm_usb_dvr_init_7445,
310 	.required_regs = {
311 		BRCM_REGS_CTRL,
312 		BRCM_REGS_XHCI_EC,
313 		-1,
314 	},
315 };
316 
317 static const struct of_device_id brcm_usb_dt_ids[] = {
318 	{
319 		.compatible = "brcm,bcm7216-usb-phy",
320 		.data = &chip_info_7216,
321 	},
322 	{
323 		.compatible = "brcm,bcm7211-usb-phy",
324 		.data = &chip_info_7211b0,
325 	},
326 	{
327 		.compatible = "brcm,brcmstb-usb-phy",
328 		.data = &chip_info_7445,
329 	},
330 	{ /* sentinel */ }
331 };
332 
brcm_usb_get_regs(struct platform_device * pdev,enum brcmusb_reg_sel regs,struct brcm_usb_init_params * ini,bool optional)333 static int brcm_usb_get_regs(struct platform_device *pdev,
334 			     enum brcmusb_reg_sel regs,
335 			     struct  brcm_usb_init_params *ini,
336 			     bool optional)
337 {
338 	struct resource *res;
339 
340 	/* Older DT nodes have ctrl and optional xhci_ec by index only */
341 	res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
342 						node_reg_names[regs]);
343 	if (res == NULL) {
344 		if (regs == BRCM_REGS_CTRL) {
345 			res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
346 		} else if (regs == BRCM_REGS_XHCI_EC) {
347 			res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
348 			/* XHCI_EC registers are optional */
349 			if (res == NULL)
350 				return 0;
351 		}
352 		if (res == NULL) {
353 			if (optional) {
354 				dev_dbg(&pdev->dev,
355 					"Optional reg %s not found\n",
356 					node_reg_names[regs]);
357 				return 0;
358 			}
359 			dev_err(&pdev->dev, "can't get %s base addr\n",
360 				node_reg_names[regs]);
361 			return 1;
362 		}
363 	}
364 	ini->regs[regs] = devm_ioremap_resource(&pdev->dev, res);
365 	if (IS_ERR(ini->regs[regs])) {
366 		dev_err(&pdev->dev, "can't map %s register space\n",
367 			node_reg_names[regs]);
368 		return 1;
369 	}
370 	return 0;
371 }
372 
brcm_usb_phy_dvr_init(struct platform_device * pdev,struct brcm_usb_phy_data * priv,struct device_node * dn)373 static int brcm_usb_phy_dvr_init(struct platform_device *pdev,
374 				 struct brcm_usb_phy_data *priv,
375 				 struct device_node *dn)
376 {
377 	struct device *dev = &pdev->dev;
378 	struct phy *gphy = NULL;
379 	int err;
380 
381 	priv->usb_20_clk = of_clk_get_by_name(dn, "sw_usb");
382 	if (IS_ERR(priv->usb_20_clk)) {
383 		if (PTR_ERR(priv->usb_20_clk) == -EPROBE_DEFER)
384 			return -EPROBE_DEFER;
385 		dev_info(dev, "Clock not found in Device Tree\n");
386 		priv->usb_20_clk = NULL;
387 	}
388 	err = clk_prepare_enable(priv->usb_20_clk);
389 	if (err)
390 		return err;
391 
392 	if (priv->has_eohci) {
393 		gphy = devm_phy_create(dev, NULL, &brcm_usb_phy_ops);
394 		if (IS_ERR(gphy)) {
395 			dev_err(dev, "failed to create EHCI/OHCI PHY\n");
396 			return PTR_ERR(gphy);
397 		}
398 		priv->phys[BRCM_USB_PHY_2_0].phy = gphy;
399 		priv->phys[BRCM_USB_PHY_2_0].id = BRCM_USB_PHY_2_0;
400 		phy_set_drvdata(gphy, &priv->phys[BRCM_USB_PHY_2_0]);
401 	}
402 
403 	if (priv->has_xhci) {
404 		gphy = devm_phy_create(dev, NULL, &brcm_usb_phy_ops);
405 		if (IS_ERR(gphy)) {
406 			dev_err(dev, "failed to create XHCI PHY\n");
407 			return PTR_ERR(gphy);
408 		}
409 		priv->phys[BRCM_USB_PHY_3_0].phy = gphy;
410 		priv->phys[BRCM_USB_PHY_3_0].id = BRCM_USB_PHY_3_0;
411 		phy_set_drvdata(gphy, &priv->phys[BRCM_USB_PHY_3_0]);
412 
413 		priv->usb_30_clk = of_clk_get_by_name(dn, "sw_usb3");
414 		if (IS_ERR(priv->usb_30_clk)) {
415 			if (PTR_ERR(priv->usb_30_clk) == -EPROBE_DEFER)
416 				return -EPROBE_DEFER;
417 			dev_info(dev,
418 				 "USB3.0 clock not found in Device Tree\n");
419 			priv->usb_30_clk = NULL;
420 		}
421 		err = clk_prepare_enable(priv->usb_30_clk);
422 		if (err)
423 			return err;
424 	}
425 
426 	priv->suspend_clk = clk_get(dev, "usb0_freerun");
427 	if (IS_ERR(priv->suspend_clk)) {
428 		if (PTR_ERR(priv->suspend_clk) == -EPROBE_DEFER)
429 			return -EPROBE_DEFER;
430 		dev_err(dev, "Suspend Clock not found in Device Tree\n");
431 		priv->suspend_clk = NULL;
432 	}
433 
434 	priv->wake_irq = platform_get_irq_byname(pdev, "wake");
435 	if (priv->wake_irq < 0)
436 		priv->wake_irq = platform_get_irq_byname(pdev, "wakeup");
437 	if (priv->wake_irq >= 0) {
438 		err = devm_request_irq(dev, priv->wake_irq,
439 				       brcm_usb_phy_wake_isr, 0,
440 				       dev_name(dev), dev);
441 		if (err < 0)
442 			return err;
443 		device_set_wakeup_capable(dev, 1);
444 	} else {
445 		dev_info(dev,
446 			 "Wake interrupt missing, system wake not supported\n");
447 	}
448 
449 	return 0;
450 }
451 
brcm_usb_phy_probe(struct platform_device * pdev)452 static int brcm_usb_phy_probe(struct platform_device *pdev)
453 {
454 	struct device *dev = &pdev->dev;
455 	struct brcm_usb_phy_data *priv;
456 	struct phy_provider *phy_provider;
457 	struct device_node *dn = pdev->dev.of_node;
458 	int err;
459 	const char *mode;
460 	const struct of_device_id *match;
461 	void (*dvr_init)(struct brcm_usb_init_params *params);
462 	const struct match_chip_info *info;
463 	struct regmap *rmap;
464 	int x;
465 
466 	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
467 	if (!priv)
468 		return -ENOMEM;
469 	platform_set_drvdata(pdev, priv);
470 
471 	priv->ini.family_id = brcmstb_get_family_id();
472 	priv->ini.product_id = brcmstb_get_product_id();
473 
474 	match = of_match_node(brcm_usb_dt_ids, dev->of_node);
475 	info = match->data;
476 	dvr_init = info->init_func;
477 	(*dvr_init)(&priv->ini);
478 
479 	dev_dbg(dev, "Best mapping table is for %s\n",
480 		priv->ini.family_name);
481 
482 	of_property_read_u32(dn, "brcm,ipp", &priv->ini.ipp);
483 	of_property_read_u32(dn, "brcm,ioc", &priv->ini.ioc);
484 
485 	priv->ini.mode = USB_CTLR_MODE_HOST;
486 	err = of_property_read_string(dn, "dr_mode", &mode);
487 	if (err == 0) {
488 		name_to_value(&brcm_dr_mode_to_name[0],
489 			      ARRAY_SIZE(brcm_dr_mode_to_name),
490 			mode, &priv->ini.mode);
491 	}
492 	if (of_property_read_bool(dn, "brcm,has-xhci"))
493 		priv->has_xhci = true;
494 	if (of_property_read_bool(dn, "brcm,has-eohci"))
495 		priv->has_eohci = true;
496 
497 	for (x = 0; x < BRCM_REGS_MAX; x++) {
498 		if (info->required_regs[x] >= BRCM_REGS_MAX)
499 			break;
500 
501 		err = brcm_usb_get_regs(pdev, info->required_regs[x],
502 					&priv->ini, false);
503 		if (err)
504 			return -EINVAL;
505 	}
506 	if (info->optional_reg) {
507 		err = brcm_usb_get_regs(pdev, info->optional_reg,
508 					&priv->ini, true);
509 		if (err)
510 			return -EINVAL;
511 	}
512 
513 	err = brcm_usb_phy_dvr_init(pdev, priv, dn);
514 	if (err)
515 		return err;
516 
517 	priv->pm_notifier.notifier_call = brcm_pm_notifier;
518 	register_pm_notifier(&priv->pm_notifier);
519 
520 	mutex_init(&priv->mutex);
521 
522 	/* make sure invert settings are correct */
523 	brcm_usb_init_ipp(&priv->ini);
524 
525 	/*
526 	 * Create sysfs entries for mode.
527 	 * Remove "dual_select" attribute if not in dual mode
528 	 */
529 	if (priv->ini.mode != USB_CTLR_MODE_DRD)
530 		brcm_usb_phy_attrs[1] = NULL;
531 	err = sysfs_create_group(&dev->kobj, &brcm_usb_phy_group);
532 	if (err)
533 		dev_warn(dev, "Error creating sysfs attributes\n");
534 
535 	/* Get piarbctl syscon if it exists */
536 	rmap = syscon_regmap_lookup_by_phandle(dev->of_node,
537 						 "syscon-piarbctl");
538 	if (IS_ERR(rmap))
539 		rmap = syscon_regmap_lookup_by_phandle(dev->of_node,
540 						       "brcm,syscon-piarbctl");
541 	if (!IS_ERR(rmap))
542 		priv->ini.syscon_piarbctl = rmap;
543 
544 	/* start with everything off */
545 	if (priv->has_xhci)
546 		brcm_usb_uninit_xhci(&priv->ini);
547 	if (priv->has_eohci)
548 		brcm_usb_uninit_eohci(&priv->ini);
549 	brcm_usb_uninit_common(&priv->ini);
550 	clk_disable_unprepare(priv->usb_20_clk);
551 	clk_disable_unprepare(priv->usb_30_clk);
552 
553 	phy_provider = devm_of_phy_provider_register(dev, brcm_usb_phy_xlate);
554 
555 	return PTR_ERR_OR_ZERO(phy_provider);
556 }
557 
brcm_usb_phy_remove(struct platform_device * pdev)558 static int brcm_usb_phy_remove(struct platform_device *pdev)
559 {
560 	struct brcm_usb_phy_data *priv = dev_get_drvdata(&pdev->dev);
561 
562 	sysfs_remove_group(&pdev->dev.kobj, &brcm_usb_phy_group);
563 	unregister_pm_notifier(&priv->pm_notifier);
564 
565 	return 0;
566 }
567 
568 #ifdef CONFIG_PM_SLEEP
brcm_usb_phy_suspend(struct device * dev)569 static int brcm_usb_phy_suspend(struct device *dev)
570 {
571 	struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);
572 
573 	if (priv->init_count) {
574 		dev_dbg(dev, "SUSPEND\n");
575 		priv->ini.wake_enabled = device_may_wakeup(dev);
576 		if (priv->phys[BRCM_USB_PHY_3_0].inited)
577 			brcm_usb_uninit_xhci(&priv->ini);
578 		if (priv->phys[BRCM_USB_PHY_2_0].inited)
579 			brcm_usb_uninit_eohci(&priv->ini);
580 		brcm_usb_uninit_common(&priv->ini);
581 
582 		/*
583 		 * Handle the clocks unless needed for wake. This has
584 		 * to work for both older XHCI->3.0-clks, EOHCI->2.0-clks
585 		 * and newer XHCI->2.0-clks/3.0-clks.
586 		 */
587 
588 		if (!priv->ini.suspend_with_clocks) {
589 			if (priv->phys[BRCM_USB_PHY_3_0].inited)
590 				clk_disable_unprepare(priv->usb_30_clk);
591 			if (priv->phys[BRCM_USB_PHY_2_0].inited ||
592 			    !priv->has_eohci)
593 				clk_disable_unprepare(priv->usb_20_clk);
594 		}
595 		if (priv->wake_irq >= 0)
596 			enable_irq_wake(priv->wake_irq);
597 	}
598 	return 0;
599 }
600 
brcm_usb_phy_resume(struct device * dev)601 static int brcm_usb_phy_resume(struct device *dev)
602 {
603 	struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);
604 
605 	clk_prepare_enable(priv->usb_20_clk);
606 	clk_prepare_enable(priv->usb_30_clk);
607 	brcm_usb_init_ipp(&priv->ini);
608 
609 	/*
610 	 * Initialize anything that was previously initialized.
611 	 * Uninitialize anything that wasn't previously initialized.
612 	 */
613 	if (priv->init_count) {
614 		dev_dbg(dev, "RESUME\n");
615 		if (priv->wake_irq >= 0)
616 			disable_irq_wake(priv->wake_irq);
617 		brcm_usb_init_common(&priv->ini);
618 		if (priv->phys[BRCM_USB_PHY_2_0].inited) {
619 			brcm_usb_init_eohci(&priv->ini);
620 		} else if (priv->has_eohci) {
621 			brcm_usb_uninit_eohci(&priv->ini);
622 			clk_disable_unprepare(priv->usb_20_clk);
623 		}
624 		if (priv->phys[BRCM_USB_PHY_3_0].inited) {
625 			brcm_usb_init_xhci(&priv->ini);
626 		} else if (priv->has_xhci) {
627 			brcm_usb_uninit_xhci(&priv->ini);
628 			clk_disable_unprepare(priv->usb_30_clk);
629 			if (!priv->has_eohci)
630 				clk_disable_unprepare(priv->usb_20_clk);
631 		}
632 	} else {
633 		if (priv->has_xhci)
634 			brcm_usb_uninit_xhci(&priv->ini);
635 		if (priv->has_eohci)
636 			brcm_usb_uninit_eohci(&priv->ini);
637 		brcm_usb_uninit_common(&priv->ini);
638 		clk_disable_unprepare(priv->usb_20_clk);
639 		clk_disable_unprepare(priv->usb_30_clk);
640 	}
641 	priv->ini.wake_enabled = false;
642 	return 0;
643 }
644 #endif /* CONFIG_PM_SLEEP */
645 
646 static const struct dev_pm_ops brcm_usb_phy_pm_ops = {
647 	SET_LATE_SYSTEM_SLEEP_PM_OPS(brcm_usb_phy_suspend, brcm_usb_phy_resume)
648 };
649 
650 MODULE_DEVICE_TABLE(of, brcm_usb_dt_ids);
651 
652 static struct platform_driver brcm_usb_driver = {
653 	.probe		= brcm_usb_phy_probe,
654 	.remove		= brcm_usb_phy_remove,
655 	.driver		= {
656 		.name	= "brcmstb-usb-phy",
657 		.pm = &brcm_usb_phy_pm_ops,
658 		.of_match_table = brcm_usb_dt_ids,
659 	},
660 };
661 
662 module_platform_driver(brcm_usb_driver);
663 
664 MODULE_ALIAS("platform:brcmstb-usb-phy");
665 MODULE_AUTHOR("Al Cooper <acooper@broadcom.com>");
666 MODULE_DESCRIPTION("BRCM USB PHY driver");
667 MODULE_LICENSE("GPL v2");
668