drivers/phy/motorola/phy-cpcap-usb.c

   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 clk *refclk;
 126         struct usb_phy phy;
 127         struct delayed_work detect_work;
 128         struct pinctrl *pins;
 129         struct pinctrl_state *pins_ulpi;
 130         struct pinctrl_state *pins_utmi;
 131         struct pinctrl_state *pins_uart;
 132         struct gpio_desc *gpio[2];
 133         struct iio_channel *vbus;
 134         struct iio_channel *id;
 135         struct regulator *vusb;
 136         atomic_t active;
 137 };
 138
 139 static bool cpcap_usb_vbus_valid(struct cpcap_phy_ddata *ddata)
 140 {
 141         int error, value = 0;
 142
 143         error = iio_read_channel_processed(ddata->vbus, &value);
 144         if (error >= 0)
 145                 return value > 3900 ? true : false;
 146
 147         dev_err(ddata->dev, "error reading VBUS: %i\n", error);
 148
 149         return false;
 150 }
 151
 152 static int cpcap_usb_phy_set_host(struct usb_otg *otg, struct usb_bus *host)
 153 {
 154         otg->host = host;
 155         if (!host)
 156                 otg->state = OTG_STATE_UNDEFINED;
 157
 158         return 0;
 159 }
 160
 161 static int cpcap_usb_phy_set_peripheral(struct usb_otg *otg,
 162                                         struct usb_gadget *gadget)
 163 {
 164         otg->gadget = gadget;
 165         if (!gadget)
 166                 otg->state = OTG_STATE_UNDEFINED;
 167
 168         return 0;
 169 }
 170
 171 static const struct phy_ops ops = {
 172         .owner          = THIS_MODULE,
 173 };
 174
 175 static int cpcap_phy_get_ints_state(struct cpcap_phy_ddata *ddata,
 176                                     struct cpcap_usb_ints_state *s)
 177 {
 178         int val, error;
 179
 180         error = regmap_read(ddata->reg, CPCAP_REG_INTS1, &val);
 181         if (error)
 182                 return error;
 183
 184         s->id_ground = val & BIT(15);
 185         s->id_float = val & BIT(14);
 186         s->vbusov = val & BIT(11);
 187
 188         error = regmap_read(ddata->reg, CPCAP_REG_INTS2, &val);
 189         if (error)
 190                 return error;
 191
 192         s->vbusvld = val & BIT(3);
 193         s->sessvld = val & BIT(2);
 194         s->sessend = val & BIT(1);
 195         s->se1 = val & BIT(0);
 196
 197         error = regmap_read(ddata->reg, CPCAP_REG_INTS4, &val);
 198         if (error)
 199                 return error;
 200
 201         s->dm = val & BIT(1);
 202         s->dp = val & BIT(0);
 203
 204         return 0;
 205 }
 206
 207 static int cpcap_usb_set_uart_mode(struct cpcap_phy_ddata *ddata);
 208 static int cpcap_usb_set_usb_mode(struct cpcap_phy_ddata *ddata);
 209
 210 static void cpcap_usb_try_musb_mailbox(struct cpcap_phy_ddata *ddata,
 211                                        enum musb_vbus_id_status status)
 212 {
 213         int error;
 214
 215         error = musb_mailbox(status);
 216         if (!error)
 217                 return;
 218
 219         dev_dbg(ddata->dev, "%s: musb_mailbox failed: %i\n",
 220                 __func__, error);
 221 }
 222
 223 static void cpcap_usb_detect(struct work_struct *work)
 224 {
 225         struct cpcap_phy_ddata *ddata;
 226         struct cpcap_usb_ints_state s;
 227         bool vbus = false;
 228         int error;
 229
 230         ddata = container_of(work, struct cpcap_phy_ddata, detect_work.work);
 231
 232         error = cpcap_phy_get_ints_state(ddata, &s);
 233         if (error)
 234                 return;
 235
 236         if (s.id_ground) {
 237                 dev_dbg(ddata->dev, "id ground, USB host mode\n");
 238                 error = cpcap_usb_set_usb_mode(ddata);
 239                 if (error)
 240                         goto out_err;
 241
 242                 cpcap_usb_try_musb_mailbox(ddata, MUSB_ID_GROUND);
 243
 244                 error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC3,
 245                                            CPCAP_BIT_VBUSSTBY_EN,
 246                                            CPCAP_BIT_VBUSSTBY_EN);
 247                 if (error)
 248                         goto out_err;
 249
 250                 return;
 251         }
 252
 253         error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC3,
 254                                    CPCAP_BIT_VBUSSTBY_EN, 0);
 255         if (error)
 256                 goto out_err;
 257
 258         vbus = cpcap_usb_vbus_valid(ddata);
 259
 260         if (vbus) {
 261                 /* Are we connected to a docking station with vbus? */
 262                 if (s.id_ground) {
 263                         dev_dbg(ddata->dev, "connected to a dock\n");
 264
 265                         /* No VBUS needed with docks */
 266                         error = cpcap_usb_set_usb_mode(ddata);
 267                         if (error)
 268                                 goto out_err;
 269                         cpcap_usb_try_musb_mailbox(ddata, MUSB_ID_GROUND);
 270
 271                         return;
 272                 }
 273
 274                 /* Otherwise assume we're connected to a USB host */
 275                 dev_dbg(ddata->dev, "connected to USB host\n");
 276                 error = cpcap_usb_set_usb_mode(ddata);
 277                 if (error)
 278                         goto out_err;
 279                 cpcap_usb_try_musb_mailbox(ddata, MUSB_VBUS_VALID);
 280
 281                 return;
 282         }
 283
 284         cpcap_usb_try_musb_mailbox(ddata, MUSB_VBUS_OFF);
 285
 286         /* Default to debug UART mode */
 287         error = cpcap_usb_set_uart_mode(ddata);
 288         if (error)
 289                 goto out_err;
 290
 291         dev_dbg(ddata->dev, "set UART mode\n");
 292
 293         return;
 294
 295 out_err:
 296         dev_err(ddata->dev, "error setting cable state: %i\n", error);
 297 }
 298
 299 static irqreturn_t cpcap_phy_irq_thread(int irq, void *data)
 300 {
 301         struct cpcap_phy_ddata *ddata = data;
 302
 303         if (!atomic_read(&ddata->active))
 304                 return IRQ_NONE;
 305
 306         schedule_delayed_work(&ddata->detect_work, msecs_to_jiffies(1));
 307
 308         return IRQ_HANDLED;
 309 }
 310
 311 static int cpcap_usb_init_irq(struct platform_device *pdev,
 312                               struct cpcap_phy_ddata *ddata,
 313                               const char *name)
 314 {
 315         int irq, error;
 316
 317         irq = platform_get_irq_byname(pdev, name);
 318         if (irq < 0)
 319                 return -ENODEV;
 320
 321         error = devm_request_threaded_irq(ddata->dev, irq, NULL,
 322                                           cpcap_phy_irq_thread,
 323                                           IRQF_SHARED,
 324                                           name, ddata);
 325         if (error) {
 326                 dev_err(ddata->dev, "could not get irq %s: %i\n",
 327                         name, error);
 328
 329                 return error;
 330         }
 331
 332         return 0;
 333 }
 334
 335 static const char * const cpcap_phy_irqs[] = {
 336         /* REG_INT_0 */
 337         "id_ground", "id_float",
 338
 339         /* REG_INT1 */
 340         "se0conn", "vbusvld", "sessvld", "sessend", "se1",
 341
 342         /* REG_INT_3 */
 343         "dm", "dp",
 344 };
 345
 346 static int cpcap_usb_init_interrupts(struct platform_device *pdev,
 347                                      struct cpcap_phy_ddata *ddata)
 348 {
 349         int i, error;
 350
 351         for (i = 0; i < ARRAY_SIZE(cpcap_phy_irqs); i++) {
 352                 error = cpcap_usb_init_irq(pdev, ddata, cpcap_phy_irqs[i]);
 353                 if (error)
 354                         return error;
 355         }
 356
 357         return 0;
 358 }
 359
 360 /*
 361  * Optional pins and modes. At least Motorola mapphone devices
 362  * are using two GPIOs and dynamic pinctrl to multiplex PHY pins
 363  * to UART, ULPI or UTMI mode.
 364  */
 365
 366 static int cpcap_usb_gpio_set_mode(struct cpcap_phy_ddata *ddata,
 367                                    enum cpcap_gpio_mode mode)
 368 {
 369         if (!ddata->gpio[0] || !ddata->gpio[1])
 370                 return 0;
 371
 372         gpiod_set_value(ddata->gpio[0], mode & 1);
 373         gpiod_set_value(ddata->gpio[1], mode >> 1);
 374
 375         return 0;
 376 }
 377
 378 static int cpcap_usb_set_uart_mode(struct cpcap_phy_ddata *ddata)
 379 {
 380         int error;
 381
 382         /* Disable lines to prevent glitches from waking up mdm6600 */
 383         error = cpcap_usb_gpio_set_mode(ddata, CPCAP_UNKNOWN_DISABLED);
 384         if (error)
 385                 goto out_err;
 386
 387         if (ddata->pins_uart) {
 388                 error = pinctrl_select_state(ddata->pins, ddata->pins_uart);
 389                 if (error)
 390                         goto out_err;
 391         }
 392
 393         error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC1,
 394                                    CPCAP_BIT_VBUSPD,
 395                                    CPCAP_BIT_VBUSPD);
 396         if (error)
 397                 goto out_err;
 398
 399         error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC2,
 400                                    0xffff, CPCAP_BIT_UARTMUX0 |
 401                                    CPCAP_BIT_EMUMODE0);
 402         if (error)
 403                 goto out_err;
 404
 405         error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC3, 0x7fff,
 406                                    CPCAP_BIT_IDPU_SPI);
 407         if (error)
 408                 goto out_err;
 409
 410         /* Enable UART mode */
 411         error = cpcap_usb_gpio_set_mode(ddata, CPCAP_DM_DP);
 412         if (error)
 413                 goto out_err;
 414
 415         return 0;
 416
 417 out_err:
 418         dev_err(ddata->dev, "%s failed with %i\n", __func__, error);
 419
 420         return error;
 421 }
 422
 423 static int cpcap_usb_set_usb_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                 return error;
 431
 432         if (ddata->pins_utmi) {
 433                 error = pinctrl_select_state(ddata->pins, ddata->pins_utmi);
 434                 if (error) {
 435                         dev_err(ddata->dev, "could not set usb mode: %i\n",
 436                                 error);
 437
 438                         return error;
 439                 }
 440         }
 441
 442         error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC1,
 443                                    CPCAP_BIT_VBUSPD, 0);
 444         if (error)
 445                 goto out_err;
 446
 447         error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC2,
 448                                    CPCAP_BIT_USBXCVREN,
 449                                    CPCAP_BIT_USBXCVREN);
 450         if (error)
 451                 goto out_err;
 452
 453         error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC3,
 454                                    CPCAP_BIT_PU_SPI |
 455                                    CPCAP_BIT_DMPD_SPI |
 456                                    CPCAP_BIT_DPPD_SPI |
 457                                    CPCAP_BIT_SUSPEND_SPI |
 458                                    CPCAP_BIT_ULPI_SPI_SEL, 0);
 459         if (error)
 460                 goto out_err;
 461
 462         error = regmap_update_bits(ddata->reg, CPCAP_REG_USBC2,
 463                                    CPCAP_BIT_USBXCVREN,
 464                                    CPCAP_BIT_USBXCVREN);
 465         if (error)
 466                 goto out_err;
 467
 468         /* Enable USB mode */
 469         error = cpcap_usb_gpio_set_mode(ddata, CPCAP_OTG_DM_DP);
 470         if (error)
 471                 goto out_err;
 472
 473         return 0;
 474
 475 out_err:
 476         dev_err(ddata->dev, "%s failed with %i\n", __func__, error);
 477
 478         return error;
 479 }
 480
 481 static int cpcap_usb_init_optional_pins(struct cpcap_phy_ddata *ddata)
 482 {
 483         ddata->pins = devm_pinctrl_get(ddata->dev);
 484         if (IS_ERR(ddata->pins)) {
 485                 dev_info(ddata->dev, "default pins not configured: %ld\n",
 486                          PTR_ERR(ddata->pins));
 487                 ddata->pins = NULL;
 488
 489                 return 0;
 490         }
 491
 492         ddata->pins_ulpi = pinctrl_lookup_state(ddata->pins, "ulpi");
 493         if (IS_ERR(ddata->pins_ulpi)) {
 494                 dev_info(ddata->dev, "ulpi pins not configured\n");
 495                 ddata->pins_ulpi = NULL;
 496         }
 497
 498         ddata->pins_utmi = pinctrl_lookup_state(ddata->pins, "utmi");
 499         if (IS_ERR(ddata->pins_utmi)) {
 500                 dev_info(ddata->dev, "utmi pins not configured\n");
 501                 ddata->pins_utmi = NULL;
 502         }
 503
 504         ddata->pins_uart = pinctrl_lookup_state(ddata->pins, "uart");
 505         if (IS_ERR(ddata->pins_uart)) {
 506                 dev_info(ddata->dev, "uart pins not configured\n");
 507                 ddata->pins_uart = NULL;
 508         }
 509
 510         if (ddata->pins_uart)
 511                 return pinctrl_select_state(ddata->pins, ddata->pins_uart);
 512
 513         return 0;
 514 }
 515
 516 static void cpcap_usb_init_optional_gpios(struct cpcap_phy_ddata *ddata)
 517 {
 518         int i;
 519
 520         for (i = 0; i < 2; i++) {
 521                 ddata->gpio[i] = devm_gpiod_get_index(ddata->dev, "mode",
 522                                                       i, GPIOD_OUT_HIGH);
 523                 if (IS_ERR(ddata->gpio[i])) {
 524                         dev_info(ddata->dev, "no mode change GPIO%i: %li\n",
 525                                  i, PTR_ERR(ddata->gpio[i]));
 526                         ddata->gpio[i] = NULL;
 527                 }
 528         }
 529 }
 530
 531 static int cpcap_usb_init_iio(struct cpcap_phy_ddata *ddata)
 532 {
 533         enum iio_chan_type type;
 534         int error;
 535
 536         ddata->vbus = devm_iio_channel_get(ddata->dev, "vbus");
 537         if (IS_ERR(ddata->vbus)) {
 538                 error = PTR_ERR(ddata->vbus);
 539                 goto out_err;
 540         }
 541
 542         if (!ddata->vbus->indio_dev) {
 543                 error = -ENXIO;
 544                 goto out_err;
 545         }
 546
 547         error = iio_get_channel_type(ddata->vbus, &type);
 548         if (error < 0)
 549                 goto out_err;
 550
 551         if (type != IIO_VOLTAGE) {
 552                 error = -EINVAL;
 553                 goto out_err;
 554         }
 555
 556         return 0;
 557
 558 out_err:
 559         dev_err(ddata->dev, "could not initialize VBUS or ID IIO: %i\n",
 560                 error);
 561
 562         return error;
 563 }
 564
 565 #ifdef CONFIG_OF
 566 static const struct of_device_id cpcap_usb_phy_id_table[] = {
 567         {
 568                 .compatible = "motorola,cpcap-usb-phy",
 569         },
 570         {
 571                 .compatible = "motorola,mapphone-cpcap-usb-phy",
 572         },
 573         {},
 574 };
 575 MODULE_DEVICE_TABLE(of, cpcap_usb_phy_id_table);
 576 #endif
 577
 578 static int cpcap_usb_phy_probe(struct platform_device *pdev)
 579 {
 580         struct cpcap_phy_ddata *ddata;
 581         struct phy *generic_phy;
 582         struct phy_provider *phy_provider;
 583         struct usb_otg *otg;
 584         const struct of_device_id *of_id;
 585         int error;
 586
 587         of_id = of_match_device(of_match_ptr(cpcap_usb_phy_id_table),
 588                                 &pdev->dev);
 589         if (!of_id)
 590                 return -EINVAL;
 591
 592         ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL);
 593         if (!ddata)
 594                 return -ENOMEM;
 595
 596         ddata->reg = dev_get_regmap(pdev->dev.parent, NULL);
 597         if (!ddata->reg)
 598                 return -ENODEV;
 599
 600         otg = devm_kzalloc(&pdev->dev, sizeof(*otg), GFP_KERNEL);
 601         if (!otg)
 602                 return -ENOMEM;
 603
 604         ddata->dev = &pdev->dev;
 605         ddata->phy.dev = ddata->dev;
 606         ddata->phy.label = "cpcap_usb_phy";
 607         ddata->phy.otg = otg;
 608         ddata->phy.type = USB_PHY_TYPE_USB2;
 609         otg->set_host = cpcap_usb_phy_set_host;
 610         otg->set_peripheral = cpcap_usb_phy_set_peripheral;
 611         otg->usb_phy = &ddata->phy;
 612         INIT_DELAYED_WORK(&ddata->detect_work, cpcap_usb_detect);
 613         platform_set_drvdata(pdev, ddata);
 614
 615         ddata->vusb = devm_regulator_get(&pdev->dev, "vusb");
 616         if (IS_ERR(ddata->vusb))
 617                 return PTR_ERR(ddata->vusb);
 618
 619         error = regulator_enable(ddata->vusb);
 620         if (error)
 621                 return error;
 622
 623         generic_phy = devm_phy_create(ddata->dev, NULL, &ops);
 624         if (IS_ERR(generic_phy)) {
 625                 error = PTR_ERR(generic_phy);
 626                 goto out_reg_disable;
 627         }
 628
 629         phy_set_drvdata(generic_phy, ddata);
 630
 631         phy_provider = devm_of_phy_provider_register(ddata->dev,
 632                                                      of_phy_simple_xlate);
 633         if (IS_ERR(phy_provider)) {
 634                 error = PTR_ERR(phy_provider);
 635                 goto out_reg_disable;
 636         }
 637
 638         error = cpcap_usb_init_optional_pins(ddata);
 639         if (error)
 640                 goto out_reg_disable;
 641
 642         cpcap_usb_init_optional_gpios(ddata);
 643
 644         error = cpcap_usb_init_iio(ddata);
 645         if (error)
 646                 goto out_reg_disable;
 647
 648         error = cpcap_usb_init_interrupts(pdev, ddata);
 649         if (error)
 650                 goto out_reg_disable;
 651
 652         usb_add_phy_dev(&ddata->phy);
 653         atomic_set(&ddata->active, 1);
 654         schedule_delayed_work(&ddata->detect_work, msecs_to_jiffies(1));
 655
 656         return 0;
 657
 658 out_reg_disable:
 659         regulator_disable(ddata->vusb);
 660
 661         return error;
 662 }
 663
 664 static int cpcap_usb_phy_remove(struct platform_device *pdev)
 665 {
 666         struct cpcap_phy_ddata *ddata = platform_get_drvdata(pdev);
 667         int error;
 668
 669         atomic_set(&ddata->active, 0);
 670         error = cpcap_usb_set_uart_mode(ddata);
 671         if (error)
 672                 dev_err(ddata->dev, "could not set UART mode\n");
 673
 674         cpcap_usb_try_musb_mailbox(ddata, MUSB_VBUS_OFF);
 675
 676         usb_remove_phy(&ddata->phy);
 677         cancel_delayed_work_sync(&ddata->detect_work);
 678         clk_unprepare(ddata->refclk);
 679         regulator_disable(ddata->vusb);
 680
 681         return 0;
 682 }
 683
 684 static struct platform_driver cpcap_usb_phy_driver = {
 685         .probe          = cpcap_usb_phy_probe,
 686         .remove         = cpcap_usb_phy_remove,
 687         .driver         = {
 688                 .name   = "cpcap-usb-phy",
 689                 .of_match_table = of_match_ptr(cpcap_usb_phy_id_table),
 690         },
 691 };
 692
 693 module_platform_driver(cpcap_usb_phy_driver);
 694
 695 MODULE_ALIAS("platform:cpcap_usb");
 696 MODULE_AUTHOR("Tony Lindgren <tony@atomide.com>");
 697 MODULE_DESCRIPTION("CPCAP usb phy driver");
 698 MODULE_LICENSE("GPL v2");