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