drivers/usb/host/ohci-da8xx.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * OHCI HCD (Host Controller Driver) for USB.
   4  *
   5  * TI DA8xx (OMAP-L1x) Bus Glue
   6  *
   7  * Derived from: ohci-omap.c and ohci-s3c2410.c
   8  * Copyright (C) 2008-2009 MontaVista Software, Inc. <[email protected]>
   9  */
  10
  11 #include <linux/clk.h>
  12 #include <linux/gpio/consumer.h>
  13 #include <linux/io.h>
  14 #include <linux/interrupt.h>
  15 #include <linux/jiffies.h>
  16 #include <linux/kernel.h>
  17 #include <linux/module.h>
  18 #include <linux/platform_device.h>
  19 #include <linux/phy/phy.h>
  20 #include <linux/platform_data/usb-davinci.h>
  21 #include <linux/regulator/consumer.h>
  22 #include <linux/usb.h>
  23 #include <linux/usb/hcd.h>
  24 #include <asm/unaligned.h>
  25
  26 #include "ohci.h"
  27
  28 #define DRIVER_DESC "DA8XX"
  29 #define DRV_NAME "ohci-da8xx"
  30
  31 static struct hc_driver __read_mostly ohci_da8xx_hc_driver;
  32
  33 static int (*orig_ohci_hub_control)(struct usb_hcd  *hcd, u16 typeReq,
  34                         u16 wValue, u16 wIndex, char *buf, u16 wLength);
  35 static int (*orig_ohci_hub_status_data)(struct usb_hcd *hcd, char *buf);
  36
  37 struct da8xx_ohci_hcd {
  38         struct usb_hcd *hcd;
  39         struct clk *usb11_clk;
  40         struct phy *usb11_phy;
  41         struct regulator *vbus_reg;
  42         struct notifier_block nb;
  43         struct gpio_desc *oc_gpio;
  44 };
  45
  46 #define to_da8xx_ohci(hcd) (struct da8xx_ohci_hcd *)(hcd_to_ohci(hcd)->priv)
  47
  48 /* Over-current indicator change bitmask */
  49 static volatile u16 ocic_mask;
  50
  51 static int ohci_da8xx_enable(struct usb_hcd *hcd)
  52 {
  53         struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
  54         int ret;
  55
  56         ret = clk_prepare_enable(da8xx_ohci->usb11_clk);
  57         if (ret)
  58                 return ret;
  59
  60         ret = phy_init(da8xx_ohci->usb11_phy);
  61         if (ret)
  62                 goto err_phy_init;
  63
  64         ret = phy_power_on(da8xx_ohci->usb11_phy);
  65         if (ret)
  66                 goto err_phy_power_on;
  67
  68         return 0;
  69
  70 err_phy_power_on:
  71         phy_exit(da8xx_ohci->usb11_phy);
  72 err_phy_init:
  73         clk_disable_unprepare(da8xx_ohci->usb11_clk);
  74
  75         return ret;
  76 }
  77
  78 static void ohci_da8xx_disable(struct usb_hcd *hcd)
  79 {
  80         struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
  81
  82         phy_power_off(da8xx_ohci->usb11_phy);
  83         phy_exit(da8xx_ohci->usb11_phy);
  84         clk_disable_unprepare(da8xx_ohci->usb11_clk);
  85 }
  86
  87 static int ohci_da8xx_set_power(struct usb_hcd *hcd, int on)
  88 {
  89         struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
  90         struct device *dev = hcd->self.controller;
  91         int ret;
  92
  93         if (!da8xx_ohci->vbus_reg)
  94                 return 0;
  95
  96         if (on) {
  97                 ret = regulator_enable(da8xx_ohci->vbus_reg);
  98                 if (ret) {
  99                         dev_err(dev, "Failed to enable regulator: %d\n", ret);
 100                         return ret;
 101                 }
 102         } else {
 103                 ret = regulator_disable(da8xx_ohci->vbus_reg);
 104                 if (ret) {
 105                         dev_err(dev, "Failed  to disable regulator: %d\n", ret);
 106                         return ret;
 107                 }
 108         }
 109
 110         return 0;
 111 }
 112
 113 static int ohci_da8xx_get_power(struct usb_hcd *hcd)
 114 {
 115         struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
 116
 117         if (da8xx_ohci->vbus_reg)
 118                 return regulator_is_enabled(da8xx_ohci->vbus_reg);
 119
 120         return 1;
 121 }
 122
 123 static int ohci_da8xx_get_oci(struct usb_hcd *hcd)
 124 {
 125         struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
 126         unsigned int flags;
 127         int ret;
 128
 129         if (da8xx_ohci->oc_gpio)
 130                 return gpiod_get_value_cansleep(da8xx_ohci->oc_gpio);
 131
 132         if (!da8xx_ohci->vbus_reg)
 133                 return 0;
 134
 135         ret = regulator_get_error_flags(da8xx_ohci->vbus_reg, &flags);
 136         if (ret)
 137                 return ret;
 138
 139         if (flags & REGULATOR_ERROR_OVER_CURRENT)
 140                 return 1;
 141
 142         return 0;
 143 }
 144
 145 static int ohci_da8xx_has_set_power(struct usb_hcd *hcd)
 146 {
 147         struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
 148
 149         if (da8xx_ohci->vbus_reg)
 150                 return 1;
 151
 152         return 0;
 153 }
 154
 155 static int ohci_da8xx_has_oci(struct usb_hcd *hcd)
 156 {
 157         struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
 158
 159         if (da8xx_ohci->oc_gpio)
 160                 return 1;
 161
 162         if (da8xx_ohci->vbus_reg)
 163                 return 1;
 164
 165         return 0;
 166 }
 167
 168 static int ohci_da8xx_has_potpgt(struct usb_hcd *hcd)
 169 {
 170         struct device *dev              = hcd->self.controller;
 171         struct da8xx_ohci_root_hub *hub = dev_get_platdata(dev);
 172
 173         if (hub && hub->potpgt)
 174                 return 1;
 175
 176         return 0;
 177 }
 178
 179 static int ohci_da8xx_regulator_event(struct notifier_block *nb,
 180                                 unsigned long event, void *data)
 181 {
 182         struct da8xx_ohci_hcd *da8xx_ohci =
 183                                 container_of(nb, struct da8xx_ohci_hcd, nb);
 184
 185         if (event & REGULATOR_EVENT_OVER_CURRENT) {
 186                 ocic_mask |= 1 << 1;
 187                 ohci_da8xx_set_power(da8xx_ohci->hcd, 0);
 188         }
 189
 190         return 0;
 191 }
 192
 193 static irqreturn_t ohci_da8xx_oc_thread(int irq, void *data)
 194 {
 195         struct da8xx_ohci_hcd *da8xx_ohci = data;
 196         struct device *dev = da8xx_ohci->hcd->self.controller;
 197         int ret;
 198
 199         if (gpiod_get_value_cansleep(da8xx_ohci->oc_gpio) &&
 200             da8xx_ohci->vbus_reg) {
 201                 ret = regulator_disable(da8xx_ohci->vbus_reg);
 202                 if (ret)
 203                         dev_err(dev, "Failed to disable regulator: %d\n", ret);
 204         }
 205
 206         return IRQ_HANDLED;
 207 }
 208
 209 static int ohci_da8xx_register_notify(struct usb_hcd *hcd)
 210 {
 211         struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
 212         struct device *dev              = hcd->self.controller;
 213         int ret = 0;
 214
 215         if (!da8xx_ohci->oc_gpio && da8xx_ohci->vbus_reg) {
 216                 da8xx_ohci->nb.notifier_call = ohci_da8xx_regulator_event;
 217                 ret = devm_regulator_register_notifier(da8xx_ohci->vbus_reg,
 218                                                 &da8xx_ohci->nb);
 219         }
 220
 221         if (ret)
 222                 dev_err(dev, "Failed to register notifier: %d\n", ret);
 223
 224         return ret;
 225 }
 226
 227 static int ohci_da8xx_reset(struct usb_hcd *hcd)
 228 {
 229         struct device *dev              = hcd->self.controller;
 230         struct da8xx_ohci_root_hub *hub = dev_get_platdata(dev);
 231         struct ohci_hcd *ohci           = hcd_to_ohci(hcd);
 232         int result;
 233         u32 rh_a;
 234
 235         dev_dbg(dev, "starting USB controller\n");
 236
 237         result = ohci_da8xx_enable(hcd);
 238         if (result < 0)
 239                 return result;
 240
 241         /*
 242          * DA8xx only have 1 port connected to the pins but the HC root hub
 243          * register A reports 2 ports, thus we'll have to override it...
 244          */
 245         ohci->num_ports = 1;
 246
 247         result = ohci_setup(hcd);
 248         if (result < 0) {
 249                 ohci_da8xx_disable(hcd);
 250                 return result;
 251         }
 252
 253         /*
 254          * Since we're providing a board-specific root hub port power control
 255          * and over-current reporting, we have to override the HC root hub A
 256          * register's default value, so that ohci_hub_control() could return
 257          * the correct hub descriptor...
 258          */
 259         rh_a = ohci_readl(ohci, &ohci->regs->roothub.a);
 260         if (ohci_da8xx_has_set_power(hcd)) {
 261                 rh_a &= ~RH_A_NPS;
 262                 rh_a |=  RH_A_PSM;
 263         }
 264         if (ohci_da8xx_has_oci(hcd)) {
 265                 rh_a &= ~RH_A_NOCP;
 266                 rh_a |=  RH_A_OCPM;
 267         }
 268         if (ohci_da8xx_has_potpgt(hcd)) {
 269                 rh_a &= ~RH_A_POTPGT;
 270                 rh_a |= hub->potpgt << 24;
 271         }
 272         ohci_writel(ohci, rh_a, &ohci->regs->roothub.a);
 273
 274         return result;
 275 }
 276
 277 /*
 278  * Update the status data from the hub with the over-current indicator change.
 279  */
 280 static int ohci_da8xx_hub_status_data(struct usb_hcd *hcd, char *buf)
 281 {
 282         int length              = orig_ohci_hub_status_data(hcd, buf);
 283
 284         /* See if we have OCIC bit set on port 1 */
 285         if (ocic_mask & (1 << 1)) {
 286                 dev_dbg(hcd->self.controller, "over-current indicator change "
 287                         "on port 1\n");
 288
 289                 if (!length)
 290                         length = 1;
 291
 292                 buf[0] |= 1 << 1;
 293         }
 294         return length;
 295 }
 296
 297 /*
 298  * Look at the control requests to the root hub and see if we need to override.
 299  */
 300 static int ohci_da8xx_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
 301                                   u16 wIndex, char *buf, u16 wLength)
 302 {
 303         struct device *dev              = hcd->self.controller;
 304         int temp;
 305
 306         switch (typeReq) {
 307         case GetPortStatus:
 308                 /* Check the port number */
 309                 if (wIndex != 1)
 310                         break;
 311
 312                 dev_dbg(dev, "GetPortStatus(%u)\n", wIndex);
 313
 314                 temp = roothub_portstatus(hcd_to_ohci(hcd), wIndex - 1);
 315
 316                 /* The port power status (PPS) bit defaults to 1 */
 317                 if (!ohci_da8xx_get_power(hcd))
 318                         temp &= ~RH_PS_PPS;
 319
 320                 /* The port over-current indicator (POCI) bit is always 0 */
 321                 if (ohci_da8xx_get_oci(hcd) > 0)
 322                         temp |=  RH_PS_POCI;
 323
 324                 /* The over-current indicator change (OCIC) bit is 0 too */
 325                 if (ocic_mask & (1 << wIndex))
 326                         temp |=  RH_PS_OCIC;
 327
 328                 put_unaligned(cpu_to_le32(temp), (__le32 *)buf);
 329                 return 0;
 330         case SetPortFeature:
 331                 temp = 1;
 332                 goto check_port;
 333         case ClearPortFeature:
 334                 temp = 0;
 335
 336 check_port:
 337                 /* Check the port number */
 338                 if (wIndex != 1)
 339                         break;
 340
 341                 switch (wValue) {
 342                 case USB_PORT_FEAT_POWER:
 343                         dev_dbg(dev, "%sPortFeature(%u): %s\n",
 344                                 temp ? "Set" : "Clear", wIndex, "POWER");
 345
 346                         return ohci_da8xx_set_power(hcd, temp) ? -EPIPE : 0;
 347                 case USB_PORT_FEAT_C_OVER_CURRENT:
 348                         dev_dbg(dev, "%sPortFeature(%u): %s\n",
 349                                 temp ? "Set" : "Clear", wIndex,
 350                                 "C_OVER_CURRENT");
 351
 352                         if (temp)
 353                                 ocic_mask |= 1 << wIndex;
 354                         else
 355                                 ocic_mask &= ~(1 << wIndex);
 356                         return 0;
 357                 }
 358         }
 359
 360         return orig_ohci_hub_control(hcd, typeReq, wValue,
 361                         wIndex, buf, wLength);
 362 }
 363
 364 /*-------------------------------------------------------------------------*/
 365 #ifdef CONFIG_OF
 366 static const struct of_device_id da8xx_ohci_ids[] = {
 367         { .compatible = "ti,da830-ohci" },
 368         { }
 369 };
 370 MODULE_DEVICE_TABLE(of, da8xx_ohci_ids);
 371 #endif
 372
 373 static int ohci_da8xx_probe(struct platform_device *pdev)
 374 {
 375         struct da8xx_ohci_hcd *da8xx_ohci;
 376         struct device *dev = &pdev->dev;
 377         int error, hcd_irq, oc_irq;
 378         struct usb_hcd  *hcd;
 379         struct resource *mem;
 380
 381         hcd = usb_create_hcd(&ohci_da8xx_hc_driver, dev, dev_name(dev));
 382         if (!hcd)
 383                 return -ENOMEM;
 384
 385         da8xx_ohci = to_da8xx_ohci(hcd);
 386         da8xx_ohci->hcd = hcd;
 387
 388         da8xx_ohci->usb11_clk = devm_clk_get(dev, NULL);
 389         if (IS_ERR(da8xx_ohci->usb11_clk)) {
 390                 error = PTR_ERR(da8xx_ohci->usb11_clk);
 391                 if (error != -EPROBE_DEFER)
 392                         dev_err(dev, "Failed to get clock.\n");
 393                 goto err;
 394         }
 395
 396         da8xx_ohci->usb11_phy = devm_phy_get(dev, "usb-phy");
 397         if (IS_ERR(da8xx_ohci->usb11_phy)) {
 398                 error = PTR_ERR(da8xx_ohci->usb11_phy);
 399                 if (error != -EPROBE_DEFER)
 400                         dev_err(dev, "Failed to get phy.\n");
 401                 goto err;
 402         }
 403
 404         da8xx_ohci->vbus_reg = devm_regulator_get_optional(dev, "vbus");
 405         if (IS_ERR(da8xx_ohci->vbus_reg)) {
 406                 error = PTR_ERR(da8xx_ohci->vbus_reg);
 407                 if (error == -ENODEV) {
 408                         da8xx_ohci->vbus_reg = NULL;
 409                 } else if (error == -EPROBE_DEFER) {
 410                         goto err;
 411                 } else {
 412                         dev_err(dev, "Failed to get regulator\n");
 413                         goto err;
 414                 }
 415         }
 416
 417         da8xx_ohci->oc_gpio = devm_gpiod_get_optional(dev, "oc", GPIOD_IN);
 418         if (IS_ERR(da8xx_ohci->oc_gpio)) {
 419                 error = PTR_ERR(da8xx_ohci->oc_gpio);
 420                 goto err;
 421         }
 422
 423         if (da8xx_ohci->oc_gpio) {
 424                 oc_irq = gpiod_to_irq(da8xx_ohci->oc_gpio);
 425                 if (oc_irq < 0) {
 426                         error = oc_irq;
 427                         goto err;
 428                 }
 429
 430                 error = devm_request_threaded_irq(dev, oc_irq, NULL,
 431                                 ohci_da8xx_oc_thread, IRQF_TRIGGER_RISING |
 432                                 IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
 433                                 "OHCI over-current indicator", da8xx_ohci);
 434                 if (error)
 435                         goto err;
 436         }
 437
 438         mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 439         hcd->regs = devm_ioremap_resource(dev, mem);
 440         if (IS_ERR(hcd->regs)) {
 441                 error = PTR_ERR(hcd->regs);
 442                 goto err;
 443         }
 444         hcd->rsrc_start = mem->start;
 445         hcd->rsrc_len = resource_size(mem);
 446
 447         hcd_irq = platform_get_irq(pdev, 0);
 448         if (hcd_irq < 0) {
 449                 error = -ENODEV;
 450                 goto err;
 451         }
 452
 453         error = usb_add_hcd(hcd, hcd_irq, 0);
 454         if (error)
 455                 goto err;
 456
 457         device_wakeup_enable(hcd->self.controller);
 458
 459         error = ohci_da8xx_register_notify(hcd);
 460         if (error)
 461                 goto err_remove_hcd;
 462
 463         return 0;
 464
 465 err_remove_hcd:
 466         usb_remove_hcd(hcd);
 467 err:
 468         usb_put_hcd(hcd);
 469         return error;
 470 }
 471
 472 static int ohci_da8xx_remove(struct platform_device *pdev)
 473 {
 474         struct usb_hcd  *hcd = platform_get_drvdata(pdev);
 475
 476         usb_remove_hcd(hcd);
 477         usb_put_hcd(hcd);
 478
 479         return 0;
 480 }
 481
 482 #ifdef CONFIG_PM
 483 static int ohci_da8xx_suspend(struct platform_device *pdev,
 484                                 pm_message_t message)
 485 {
 486         struct usb_hcd  *hcd    = platform_get_drvdata(pdev);
 487         struct ohci_hcd *ohci   = hcd_to_ohci(hcd);
 488         bool            do_wakeup       = device_may_wakeup(&pdev->dev);
 489         int             ret;
 490
 491
 492         if (time_before(jiffies, ohci->next_statechange))
 493                 msleep(5);
 494         ohci->next_statechange = jiffies;
 495
 496         ret = ohci_suspend(hcd, do_wakeup);
 497         if (ret)
 498                 return ret;
 499
 500         ohci_da8xx_disable(hcd);
 501         hcd->state = HC_STATE_SUSPENDED;
 502
 503         return ret;
 504 }
 505
 506 static int ohci_da8xx_resume(struct platform_device *dev)
 507 {
 508         struct usb_hcd  *hcd    = platform_get_drvdata(dev);
 509         struct ohci_hcd *ohci   = hcd_to_ohci(hcd);
 510         int ret;
 511
 512         if (time_before(jiffies, ohci->next_statechange))
 513                 msleep(5);
 514         ohci->next_statechange = jiffies;
 515
 516         ret = ohci_da8xx_enable(hcd);
 517         if (ret)
 518                 return ret;
 519
 520         ohci_resume(hcd, false);
 521
 522         return 0;
 523 }
 524 #endif
 525
 526 static const struct ohci_driver_overrides da8xx_overrides __initconst = {
 527         .reset           = ohci_da8xx_reset,
 528         .extra_priv_size = sizeof(struct da8xx_ohci_hcd),
 529 };
 530
 531 /*
 532  * Driver definition to register with platform structure.
 533  */
 534 static struct platform_driver ohci_hcd_da8xx_driver = {
 535         .probe          = ohci_da8xx_probe,
 536         .remove         = ohci_da8xx_remove,
 537         .shutdown       = usb_hcd_platform_shutdown,
 538 #ifdef  CONFIG_PM
 539         .suspend        = ohci_da8xx_suspend,
 540         .resume         = ohci_da8xx_resume,
 541 #endif
 542         .driver         = {
 543                 .name   = DRV_NAME,
 544                 .of_match_table = of_match_ptr(da8xx_ohci_ids),
 545         },
 546 };
 547
 548 static int __init ohci_da8xx_init(void)
 549 {
 550
 551         if (usb_disabled())
 552                 return -ENODEV;
 553
 554         ohci_init_driver(&ohci_da8xx_hc_driver, &da8xx_overrides);
 555
 556         /*
 557          * The Davinci da8xx HW has some unusual quirks, which require
 558          * da8xx-specific workarounds. We override certain hc_driver
 559          * functions here to achieve that. We explicitly do not enhance
 560          * ohci_driver_overrides to allow this more easily, since this
 561          * is an unusual case, and we don't want to encourage others to
 562          * override these functions by making it too easy.
 563          */
 564
 565         orig_ohci_hub_control = ohci_da8xx_hc_driver.hub_control;
 566         orig_ohci_hub_status_data = ohci_da8xx_hc_driver.hub_status_data;
 567
 568         ohci_da8xx_hc_driver.hub_status_data     = ohci_da8xx_hub_status_data;
 569         ohci_da8xx_hc_driver.hub_control         = ohci_da8xx_hub_control;
 570
 571         return platform_driver_register(&ohci_hcd_da8xx_driver);
 572 }
 573 module_init(ohci_da8xx_init);
 574
 575 static void __exit ohci_da8xx_exit(void)
 576 {
 577         platform_driver_unregister(&ohci_hcd_da8xx_driver);
 578 }
 579 module_exit(ohci_da8xx_exit);
 580 MODULE_DESCRIPTION(DRIVER_DESC);
 581 MODULE_LICENSE("GPL");
 582 MODULE_ALIAS("platform:" DRV_NAME);