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
cpcap_usb_vbus_valid(struct cpcap_phy_ddata * ddata)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
cpcap_usb_phy_set_host(struct usb_otg * otg,struct usb_bus * host)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
cpcap_usb_phy_set_peripheral(struct usb_otg * otg,struct usb_gadget * gadget)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
cpcap_phy_get_ints_state(struct cpcap_phy_ddata * ddata,struct cpcap_usb_ints_state * s)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
cpcap_usb_try_musb_mailbox(struct cpcap_phy_ddata * ddata,enum musb_vbus_id_status status)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
cpcap_usb_detect(struct work_struct * work)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
cpcap_phy_irq_thread(int irq,void * data)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
cpcap_usb_init_irq(struct platform_device * pdev,struct cpcap_phy_ddata * ddata,const char * name)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
cpcap_usb_init_interrupts(struct platform_device * pdev,struct cpcap_phy_ddata * ddata)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
cpcap_usb_gpio_set_mode(struct cpcap_phy_ddata * ddata,enum cpcap_gpio_mode mode)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
cpcap_usb_set_uart_mode(struct cpcap_phy_ddata * ddata)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
cpcap_usb_set_usb_mode(struct cpcap_phy_ddata * ddata)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
cpcap_usb_init_optional_pins(struct cpcap_phy_ddata * ddata)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
cpcap_usb_init_optional_gpios(struct cpcap_phy_ddata * ddata)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
cpcap_usb_init_iio(struct cpcap_phy_ddata * ddata)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
cpcap_usb_phy_probe(struct platform_device * pdev)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
cpcap_usb_phy_remove(struct platform_device * pdev)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