xref: /linux/drivers/phy/motorola/phy-cpcap-usb.c (revision c532de5a67a70f8533d495f8f2aaa9a0491c3ad0)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Motorola CPCAP PMIC USB PHY driver
4  * Copyright (C) 2017 Tony Lindgren <tony@atomide.com>
5  *
6  * Some parts based on earlier Motorola Linux kernel tree code in
7  * board-mapphone-usb.c and cpcap-usb-det.c:
8  * Copyright (C) 2007 - 2011 Motorola, Inc.
9  */
10 
11 #include <linux/atomic.h>
12 #include <linux/clk.h>
13 #include <linux/delay.h>
14 #include <linux/err.h>
15 #include <linux/io.h>
16 #include <linux/module.h>
17 #include <linux/of.h>
18 #include <linux/iio/consumer.h>
19 #include <linux/pinctrl/consumer.h>
20 #include <linux/platform_device.h>
21 #include <linux/regmap.h>
22 #include <linux/slab.h>
23 
24 #include <linux/gpio/consumer.h>
25 #include <linux/mfd/motorola-cpcap.h>
26 #include <linux/phy/omap_usb.h>
27 #include <linux/phy/phy.h>
28 #include <linux/regulator/consumer.h>
29 #include <linux/usb/musb.h>
30 
31 /* CPCAP_REG_USBC1 register bits */
32 #define CPCAP_BIT_IDPULSE		BIT(15)
33 #define CPCAP_BIT_ID100KPU		BIT(14)
34 #define CPCAP_BIT_IDPUCNTRL		BIT(13)
35 #define CPCAP_BIT_IDPU			BIT(12)
36 #define CPCAP_BIT_IDPD			BIT(11)
37 #define CPCAP_BIT_VBUSCHRGTMR3		BIT(10)
38 #define CPCAP_BIT_VBUSCHRGTMR2		BIT(9)
39 #define CPCAP_BIT_VBUSCHRGTMR1		BIT(8)
40 #define CPCAP_BIT_VBUSCHRGTMR0		BIT(7)
41 #define CPCAP_BIT_VBUSPU		BIT(6)
42 #define CPCAP_BIT_VBUSPD		BIT(5)
43 #define CPCAP_BIT_DMPD			BIT(4)
44 #define CPCAP_BIT_DPPD			BIT(3)
45 #define CPCAP_BIT_DM1K5PU		BIT(2)
46 #define CPCAP_BIT_DP1K5PU		BIT(1)
47 #define CPCAP_BIT_DP150KPU		BIT(0)
48 
49 /* CPCAP_REG_USBC2 register bits */
50 #define CPCAP_BIT_ZHSDRV1		BIT(15)
51 #define CPCAP_BIT_ZHSDRV0		BIT(14)
52 #define CPCAP_BIT_DPLLCLKREQ		BIT(13)
53 #define CPCAP_BIT_SE0CONN		BIT(12)
54 #define CPCAP_BIT_UARTTXTRI		BIT(11)
55 #define CPCAP_BIT_UARTSWAP		BIT(10)
56 #define CPCAP_BIT_UARTMUX1		BIT(9)
57 #define CPCAP_BIT_UARTMUX0		BIT(8)
58 #define CPCAP_BIT_ULPISTPLOW		BIT(7)
59 #define CPCAP_BIT_TXENPOL		BIT(6)
60 #define CPCAP_BIT_USBXCVREN		BIT(5)
61 #define CPCAP_BIT_USBCNTRL		BIT(4)
62 #define CPCAP_BIT_USBSUSPEND		BIT(3)
63 #define CPCAP_BIT_EMUMODE2		BIT(2)
64 #define CPCAP_BIT_EMUMODE1		BIT(1)
65 #define CPCAP_BIT_EMUMODE0		BIT(0)
66 
67 /* CPCAP_REG_USBC3 register bits */
68 #define CPCAP_BIT_SPARE_898_15		BIT(15)
69 #define CPCAP_BIT_IHSTX03		BIT(14)
70 #define CPCAP_BIT_IHSTX02		BIT(13)
71 #define CPCAP_BIT_IHSTX01		BIT(12)
72 #define CPCAP_BIT_IHSTX0		BIT(11)
73 #define CPCAP_BIT_IDPU_SPI		BIT(10)
74 #define CPCAP_BIT_UNUSED_898_9		BIT(9)
75 #define CPCAP_BIT_VBUSSTBY_EN		BIT(8)
76 #define CPCAP_BIT_VBUSEN_SPI		BIT(7)
77 #define CPCAP_BIT_VBUSPU_SPI		BIT(6)
78 #define CPCAP_BIT_VBUSPD_SPI		BIT(5)
79 #define CPCAP_BIT_DMPD_SPI		BIT(4)
80 #define CPCAP_BIT_DPPD_SPI		BIT(3)
81 #define CPCAP_BIT_SUSPEND_SPI		BIT(2)
82 #define CPCAP_BIT_PU_SPI		BIT(1)
83 #define CPCAP_BIT_ULPI_SPI_SEL		BIT(0)
84 
85 struct cpcap_usb_ints_state {
86 	bool id_ground;
87 	bool id_float;
88 	bool chrg_det;
89 	bool rvrs_chrg;
90 	bool vbusov;
91 
92 	bool chrg_se1b;
93 	bool se0conn;
94 	bool rvrs_mode;
95 	bool chrgcurr1;
96 	bool vbusvld;
97 	bool sessvld;
98 	bool sessend;
99 	bool se1;
100 
101 	bool battdetb;
102 	bool dm;
103 	bool dp;
104 };
105 
106 enum cpcap_gpio_mode {
107 	CPCAP_DM_DP,
108 	CPCAP_MDM_RX_TX,
109 	CPCAP_UNKNOWN_DISABLED,	/* Seems to disable USB lines */
110 	CPCAP_OTG_DM_DP,
111 };
112 
113 struct cpcap_phy_ddata {
114 	struct regmap *reg;
115 	struct device *dev;
116 	struct usb_phy phy;
117 	struct delayed_work detect_work;
118 	struct pinctrl *pins;
119 	struct pinctrl_state *pins_ulpi;
120 	struct pinctrl_state *pins_utmi;
121 	struct pinctrl_state *pins_uart;
122 	struct gpio_desc *gpio[2];
123 	struct iio_channel *vbus;
124 	struct iio_channel *id;
125 	struct regulator *vusb;
126 	atomic_t active;
127 	unsigned int vbus_provider:1;
128 	unsigned int docked:1;
129 };
130 
131 static bool cpcap_usb_vbus_valid(struct cpcap_phy_ddata *ddata)
132 {
133 	int error, value = 0;
134 
135 	error = iio_read_channel_processed(ddata->vbus, &value);
136 	if (error >= 0)
137 		return value > 3900;
138 
139 	dev_err(ddata->dev, "error reading VBUS: %i\n", error);
140 
141 	return false;
142 }
143 
144 static int cpcap_usb_phy_set_host(struct usb_otg *otg, struct usb_bus *host)
145 {
146 	otg->host = host;
147 	if (!host)
148 		otg->state = OTG_STATE_UNDEFINED;
149 
150 	return 0;
151 }
152 
153 static int cpcap_usb_phy_set_peripheral(struct usb_otg *otg,
154 					struct usb_gadget *gadget)
155 {
156 	otg->gadget = gadget;
157 	if (!gadget)
158 		otg->state = OTG_STATE_UNDEFINED;
159 
160 	return 0;
161 }
162 
163 static const struct phy_ops ops = {
164 	.owner		= THIS_MODULE,
165 };
166 
167 static int cpcap_phy_get_ints_state(struct cpcap_phy_ddata *ddata,
168 				    struct cpcap_usb_ints_state *s)
169 {
170 	int val, error;
171 
172 	error = regmap_read(ddata->reg, CPCAP_REG_INTS1, &val);
173 	if (error)
174 		return error;
175 
176 	s->id_ground = val & BIT(15);
177 	s->id_float = val & BIT(14);
178 	s->vbusov = val & BIT(11);
179 
180 	error = regmap_read(ddata->reg, CPCAP_REG_INTS2, &val);
181 	if (error)
182 		return error;
183 
184 	s->vbusvld = val & BIT(3);
185 	s->sessvld = val & BIT(2);
186 	s->sessend = val & BIT(1);
187 	s->se1 = val & BIT(0);
188 
189 	error = regmap_read(ddata->reg, CPCAP_REG_INTS4, &val);
190 	if (error)
191 		return error;
192 
193 	s->dm = val & BIT(1);
194 	s->dp = val & BIT(0);
195 
196 	return 0;
197 }
198 
199 static int cpcap_usb_set_uart_mode(struct cpcap_phy_ddata *ddata);
200 static int cpcap_usb_set_usb_mode(struct cpcap_phy_ddata *ddata);
201 
202 static void cpcap_usb_try_musb_mailbox(struct cpcap_phy_ddata *ddata,
203 				       enum musb_vbus_id_status status)
204 {
205 	int error;
206 
207 	error = musb_mailbox(status);
208 	if (!error)
209 		return;
210 
211 	dev_dbg(ddata->dev, "%s: musb_mailbox failed: %i\n",
212 		__func__, error);
213 }
214 
215 static void cpcap_usb_detect(struct work_struct *work)
216 {
217 	struct cpcap_phy_ddata *ddata;
218 	struct cpcap_usb_ints_state s;
219 	bool vbus = false;
220 	int error;
221 
222 	ddata = container_of(work, struct cpcap_phy_ddata, detect_work.work);
223 
224 	error = cpcap_phy_get_ints_state(ddata, &s);
225 	if (error)
226 		return;
227 
228 	vbus = cpcap_usb_vbus_valid(ddata);
229 
230 	/* We need to kick the VBUS as USB A-host */
231 	if (s.id_ground && ddata->vbus_provider) {
232 		dev_dbg(ddata->dev, "still in USB A-host mode, kicking VBUS\n");
233 
234 		cpcap_usb_try_musb_mailbox(ddata, MUSB_ID_GROUND);
235 
236 		error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC3,
237 					   CPCAP_BIT_VBUSSTBY_EN |
238 					   CPCAP_BIT_VBUSEN_SPI,
239 					   CPCAP_BIT_VBUSEN_SPI);
240 		if (error)
241 			goto out_err;
242 
243 		return;
244 	}
245 
246 	if (vbus && s.id_ground && ddata->docked) {
247 		dev_dbg(ddata->dev, "still docked as A-host, signal ID down\n");
248 
249 		cpcap_usb_try_musb_mailbox(ddata, MUSB_ID_GROUND);
250 
251 		return;
252 	}
253 
254 	/* No VBUS needed with docks */
255 	if (vbus && s.id_ground && !ddata->vbus_provider) {
256 		dev_dbg(ddata->dev, "connected to a dock\n");
257 
258 		ddata->docked = true;
259 
260 		error = cpcap_usb_set_usb_mode(ddata);
261 		if (error)
262 			goto out_err;
263 
264 		cpcap_usb_try_musb_mailbox(ddata, MUSB_ID_GROUND);
265 
266 		/*
267 		 * Force check state again after musb has reoriented,
268 		 * otherwise devices won't enumerate after loading PHY
269 		 * driver.
270 		 */
271 		schedule_delayed_work(&ddata->detect_work,
272 				      msecs_to_jiffies(1000));
273 
274 		return;
275 	}
276 
277 	if (s.id_ground && !ddata->docked) {
278 		dev_dbg(ddata->dev, "id ground, USB host mode\n");
279 
280 		ddata->vbus_provider = true;
281 
282 		error = cpcap_usb_set_usb_mode(ddata);
283 		if (error)
284 			goto out_err;
285 
286 		cpcap_usb_try_musb_mailbox(ddata, MUSB_ID_GROUND);
287 
288 		error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC3,
289 					   CPCAP_BIT_VBUSSTBY_EN |
290 					   CPCAP_BIT_VBUSEN_SPI,
291 					   CPCAP_BIT_VBUSEN_SPI);
292 		if (error)
293 			goto out_err;
294 
295 		return;
296 	}
297 
298 	error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC3,
299 				   CPCAP_BIT_VBUSSTBY_EN |
300 				   CPCAP_BIT_VBUSEN_SPI, 0);
301 	if (error)
302 		goto out_err;
303 
304 	vbus = cpcap_usb_vbus_valid(ddata);
305 
306 	/* Otherwise assume we're connected to a USB host */
307 	if (vbus) {
308 		dev_dbg(ddata->dev, "connected to USB host\n");
309 		error = cpcap_usb_set_usb_mode(ddata);
310 		if (error)
311 			goto out_err;
312 		cpcap_usb_try_musb_mailbox(ddata, MUSB_VBUS_VALID);
313 
314 		return;
315 	}
316 
317 	ddata->vbus_provider = false;
318 	ddata->docked = false;
319 	cpcap_usb_try_musb_mailbox(ddata, MUSB_VBUS_OFF);
320 
321 	/* Default to debug UART mode */
322 	error = cpcap_usb_set_uart_mode(ddata);
323 	if (error)
324 		goto out_err;
325 
326 	dev_dbg(ddata->dev, "set UART mode\n");
327 
328 	return;
329 
330 out_err:
331 	dev_err(ddata->dev, "error setting cable state: %i\n", error);
332 }
333 
334 static irqreturn_t cpcap_phy_irq_thread(int irq, void *data)
335 {
336 	struct cpcap_phy_ddata *ddata = data;
337 
338 	if (!atomic_read(&ddata->active))
339 		return IRQ_NONE;
340 
341 	schedule_delayed_work(&ddata->detect_work, msecs_to_jiffies(1));
342 
343 	return IRQ_HANDLED;
344 }
345 
346 static int cpcap_usb_init_irq(struct platform_device *pdev,
347 			      struct cpcap_phy_ddata *ddata,
348 			      const char *name)
349 {
350 	int irq, error;
351 
352 	irq = platform_get_irq_byname(pdev, name);
353 	if (irq < 0)
354 		return -ENODEV;
355 
356 	error = devm_request_threaded_irq(ddata->dev, irq, NULL,
357 					  cpcap_phy_irq_thread,
358 					  IRQF_SHARED |
359 					  IRQF_ONESHOT,
360 					  name, ddata);
361 	if (error) {
362 		dev_err(ddata->dev, "could not get irq %s: %i\n",
363 			name, error);
364 
365 		return error;
366 	}
367 
368 	return 0;
369 }
370 
371 static const char * const cpcap_phy_irqs[] = {
372 	/* REG_INT_0 */
373 	"id_ground", "id_float",
374 
375 	/* REG_INT1 */
376 	"se0conn", "vbusvld", "sessvld", "sessend", "se1",
377 
378 	/* REG_INT_3 */
379 	"dm", "dp",
380 };
381 
382 static int cpcap_usb_init_interrupts(struct platform_device *pdev,
383 				     struct cpcap_phy_ddata *ddata)
384 {
385 	int i, error;
386 
387 	for (i = 0; i < ARRAY_SIZE(cpcap_phy_irqs); i++) {
388 		error = cpcap_usb_init_irq(pdev, ddata, cpcap_phy_irqs[i]);
389 		if (error)
390 			return error;
391 	}
392 
393 	return 0;
394 }
395 
396 /*
397  * Optional pins and modes. At least Motorola mapphone devices
398  * are using two GPIOs and dynamic pinctrl to multiplex PHY pins
399  * to UART, ULPI or UTMI mode.
400  */
401 
402 static int cpcap_usb_gpio_set_mode(struct cpcap_phy_ddata *ddata,
403 				   enum cpcap_gpio_mode mode)
404 {
405 	if (!ddata->gpio[0] || !ddata->gpio[1])
406 		return 0;
407 
408 	gpiod_set_value(ddata->gpio[0], mode & 1);
409 	gpiod_set_value(ddata->gpio[1], mode >> 1);
410 
411 	return 0;
412 }
413 
414 static int cpcap_usb_set_uart_mode(struct cpcap_phy_ddata *ddata)
415 {
416 	int error;
417 
418 	/* Disable lines to prevent glitches from waking up mdm6600 */
419 	error = cpcap_usb_gpio_set_mode(ddata, CPCAP_UNKNOWN_DISABLED);
420 	if (error)
421 		goto out_err;
422 
423 	if (ddata->pins_uart) {
424 		error = pinctrl_select_state(ddata->pins, ddata->pins_uart);
425 		if (error)
426 			goto out_err;
427 	}
428 
429 	error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC1,
430 				   CPCAP_BIT_VBUSPD,
431 				   CPCAP_BIT_VBUSPD);
432 	if (error)
433 		goto out_err;
434 
435 	error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC2,
436 				   0xffff, CPCAP_BIT_UARTMUX0 |
437 				   CPCAP_BIT_EMUMODE0);
438 	if (error)
439 		goto out_err;
440 
441 	error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC3, 0x7fff,
442 				   CPCAP_BIT_IDPU_SPI);
443 	if (error)
444 		goto out_err;
445 
446 	/* Enable UART mode */
447 	error = cpcap_usb_gpio_set_mode(ddata, CPCAP_DM_DP);
448 	if (error)
449 		goto out_err;
450 
451 	return 0;
452 
453 out_err:
454 	dev_err(ddata->dev, "%s failed with %i\n", __func__, error);
455 
456 	return error;
457 }
458 
459 static int cpcap_usb_set_usb_mode(struct cpcap_phy_ddata *ddata)
460 {
461 	int error;
462 
463 	/* Disable lines to prevent glitches from waking up mdm6600 */
464 	error = cpcap_usb_gpio_set_mode(ddata, CPCAP_UNKNOWN_DISABLED);
465 	if (error)
466 		return error;
467 
468 	if (ddata->pins_utmi) {
469 		error = pinctrl_select_state(ddata->pins, ddata->pins_utmi);
470 		if (error) {
471 			dev_err(ddata->dev, "could not set usb mode: %i\n",
472 				error);
473 
474 			return error;
475 		}
476 	}
477 
478 	error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC1,
479 				   CPCAP_BIT_VBUSPD, 0);
480 	if (error)
481 		goto out_err;
482 
483 	error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC3,
484 				   CPCAP_BIT_PU_SPI |
485 				   CPCAP_BIT_DMPD_SPI |
486 				   CPCAP_BIT_DPPD_SPI |
487 				   CPCAP_BIT_SUSPEND_SPI |
488 				   CPCAP_BIT_ULPI_SPI_SEL, 0);
489 	if (error)
490 		goto out_err;
491 
492 	error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC2,
493 				   CPCAP_BIT_USBXCVREN,
494 				   CPCAP_BIT_USBXCVREN);
495 	if (error)
496 		goto out_err;
497 
498 	/* Enable USB mode */
499 	error = cpcap_usb_gpio_set_mode(ddata, CPCAP_OTG_DM_DP);
500 	if (error)
501 		goto out_err;
502 
503 	return 0;
504 
505 out_err:
506 	dev_err(ddata->dev, "%s failed with %i\n", __func__, error);
507 
508 	return error;
509 }
510 
511 static int cpcap_usb_init_optional_pins(struct cpcap_phy_ddata *ddata)
512 {
513 	ddata->pins = devm_pinctrl_get(ddata->dev);
514 	if (IS_ERR(ddata->pins)) {
515 		dev_info(ddata->dev, "default pins not configured: %ld\n",
516 			 PTR_ERR(ddata->pins));
517 		ddata->pins = NULL;
518 
519 		return 0;
520 	}
521 
522 	ddata->pins_ulpi = pinctrl_lookup_state(ddata->pins, "ulpi");
523 	if (IS_ERR(ddata->pins_ulpi)) {
524 		dev_info(ddata->dev, "ulpi pins not configured\n");
525 		ddata->pins_ulpi = NULL;
526 	}
527 
528 	ddata->pins_utmi = pinctrl_lookup_state(ddata->pins, "utmi");
529 	if (IS_ERR(ddata->pins_utmi)) {
530 		dev_info(ddata->dev, "utmi pins not configured\n");
531 		ddata->pins_utmi = NULL;
532 	}
533 
534 	ddata->pins_uart = pinctrl_lookup_state(ddata->pins, "uart");
535 	if (IS_ERR(ddata->pins_uart)) {
536 		dev_info(ddata->dev, "uart pins not configured\n");
537 		ddata->pins_uart = NULL;
538 	}
539 
540 	if (ddata->pins_uart)
541 		return pinctrl_select_state(ddata->pins, ddata->pins_uart);
542 
543 	return 0;
544 }
545 
546 static void cpcap_usb_init_optional_gpios(struct cpcap_phy_ddata *ddata)
547 {
548 	int i;
549 
550 	for (i = 0; i < 2; i++) {
551 		ddata->gpio[i] = devm_gpiod_get_index(ddata->dev, "mode",
552 						      i, GPIOD_OUT_HIGH);
553 		if (IS_ERR(ddata->gpio[i])) {
554 			dev_info(ddata->dev, "no mode change GPIO%i: %li\n",
555 				 i, PTR_ERR(ddata->gpio[i]));
556 			ddata->gpio[i] = NULL;
557 		}
558 	}
559 }
560 
561 static int cpcap_usb_init_iio(struct cpcap_phy_ddata *ddata)
562 {
563 	enum iio_chan_type type;
564 	int error;
565 
566 	ddata->vbus = devm_iio_channel_get(ddata->dev, "vbus");
567 	if (IS_ERR(ddata->vbus)) {
568 		error = PTR_ERR(ddata->vbus);
569 		goto out_err;
570 	}
571 
572 	if (!ddata->vbus->indio_dev) {
573 		error = -ENXIO;
574 		goto out_err;
575 	}
576 
577 	error = iio_get_channel_type(ddata->vbus, &type);
578 	if (error < 0)
579 		goto out_err;
580 
581 	if (type != IIO_VOLTAGE) {
582 		error = -EINVAL;
583 		goto out_err;
584 	}
585 
586 	return 0;
587 
588 out_err:
589 	dev_err(ddata->dev, "could not initialize VBUS or ID IIO: %i\n",
590 		error);
591 
592 	return error;
593 }
594 
595 #ifdef CONFIG_OF
596 static const struct of_device_id cpcap_usb_phy_id_table[] = {
597 	{
598 		.compatible = "motorola,cpcap-usb-phy",
599 	},
600 	{
601 		.compatible = "motorola,mapphone-cpcap-usb-phy",
602 	},
603 	{},
604 };
605 MODULE_DEVICE_TABLE(of, cpcap_usb_phy_id_table);
606 #endif
607 
608 static int cpcap_usb_phy_probe(struct platform_device *pdev)
609 {
610 	struct cpcap_phy_ddata *ddata;
611 	struct phy *generic_phy;
612 	struct phy_provider *phy_provider;
613 	struct usb_otg *otg;
614 	int error;
615 
616 	ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL);
617 	if (!ddata)
618 		return -ENOMEM;
619 
620 	ddata->reg = dev_get_regmap(pdev->dev.parent, NULL);
621 	if (!ddata->reg)
622 		return -ENODEV;
623 
624 	otg = devm_kzalloc(&pdev->dev, sizeof(*otg), GFP_KERNEL);
625 	if (!otg)
626 		return -ENOMEM;
627 
628 	ddata->dev = &pdev->dev;
629 	ddata->phy.dev = ddata->dev;
630 	ddata->phy.label = "cpcap_usb_phy";
631 	ddata->phy.otg = otg;
632 	ddata->phy.type = USB_PHY_TYPE_USB2;
633 	otg->set_host = cpcap_usb_phy_set_host;
634 	otg->set_peripheral = cpcap_usb_phy_set_peripheral;
635 	otg->usb_phy = &ddata->phy;
636 	INIT_DELAYED_WORK(&ddata->detect_work, cpcap_usb_detect);
637 	platform_set_drvdata(pdev, ddata);
638 
639 	ddata->vusb = devm_regulator_get(&pdev->dev, "vusb");
640 	if (IS_ERR(ddata->vusb))
641 		return PTR_ERR(ddata->vusb);
642 
643 	error = regulator_enable(ddata->vusb);
644 	if (error)
645 		return error;
646 
647 	generic_phy = devm_phy_create(ddata->dev, NULL, &ops);
648 	if (IS_ERR(generic_phy)) {
649 		error = PTR_ERR(generic_phy);
650 		goto out_reg_disable;
651 	}
652 
653 	phy_set_drvdata(generic_phy, ddata);
654 
655 	phy_provider = devm_of_phy_provider_register(ddata->dev,
656 						     of_phy_simple_xlate);
657 	if (IS_ERR(phy_provider)) {
658 		error = PTR_ERR(phy_provider);
659 		goto out_reg_disable;
660 	}
661 
662 	error = cpcap_usb_init_optional_pins(ddata);
663 	if (error)
664 		goto out_reg_disable;
665 
666 	cpcap_usb_init_optional_gpios(ddata);
667 
668 	error = cpcap_usb_init_iio(ddata);
669 	if (error)
670 		goto out_reg_disable;
671 
672 	error = cpcap_usb_init_interrupts(pdev, ddata);
673 	if (error)
674 		goto out_reg_disable;
675 
676 	usb_add_phy_dev(&ddata->phy);
677 	atomic_set(&ddata->active, 1);
678 	schedule_delayed_work(&ddata->detect_work, msecs_to_jiffies(1));
679 
680 	return 0;
681 
682 out_reg_disable:
683 	regulator_disable(ddata->vusb);
684 
685 	return error;
686 }
687 
688 static void cpcap_usb_phy_remove(struct platform_device *pdev)
689 {
690 	struct cpcap_phy_ddata *ddata = platform_get_drvdata(pdev);
691 	int error;
692 
693 	atomic_set(&ddata->active, 0);
694 	error = cpcap_usb_set_uart_mode(ddata);
695 	if (error)
696 		dev_err(ddata->dev, "could not set UART mode\n");
697 
698 	cpcap_usb_try_musb_mailbox(ddata, MUSB_VBUS_OFF);
699 
700 	usb_remove_phy(&ddata->phy);
701 	cancel_delayed_work_sync(&ddata->detect_work);
702 	regulator_disable(ddata->vusb);
703 }
704 
705 static struct platform_driver cpcap_usb_phy_driver = {
706 	.probe		= cpcap_usb_phy_probe,
707 	.remove_new	= cpcap_usb_phy_remove,
708 	.driver		= {
709 		.name	= "cpcap-usb-phy",
710 		.of_match_table = of_match_ptr(cpcap_usb_phy_id_table),
711 	},
712 };
713 
714 module_platform_driver(cpcap_usb_phy_driver);
715 
716 MODULE_ALIAS("platform:cpcap_usb");
717 MODULE_AUTHOR("Tony Lindgren <tony@atomide.com>");
718 MODULE_DESCRIPTION("CPCAP usb phy driver");
719 MODULE_LICENSE("GPL v2");
720