drivers/usb/renesas_usbhs/common.c

   1 /*
   2  * Renesas USB driver
   3  *
   4  * Copyright (C) 2011 Renesas Solutions Corp.
   5  * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
   6  *
   7  * This program is distributed in the hope that it will be useful,
   8  * but WITHOUT ANY WARRANTY; without even the implied warranty of
   9  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  10  * GNU General Public License for more details.
  11  *
  12  * You should have received a copy of the GNU General Public License
  13  * along with this program; if not, write to the Free Software
  14  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  15  *
  16  */
  17 #include <linux/err.h>
  18 #include <linux/gpio.h>
  19 #include <linux/io.h>
  20 #include <linux/module.h>
  21 #include <linux/of_device.h>
  22 #include <linux/of_gpio.h>
  23 #include <linux/pm_runtime.h>
  24 #include <linux/slab.h>
  25 #include <linux/sysfs.h>
  26 #include "common.h"
  27 #include "rcar2.h"
  28
  29 /*
  30  *              image of renesas_usbhs
  31  *
  32  * ex) gadget case
  33
  34  * mod.c
  35  * mod_gadget.c
  36  * mod_host.c           pipe.c          fifo.c
  37  *
  38  *                      +-------+       +-----------+
  39  *                      | pipe0 |------>| fifo pio  |
  40  * +------------+       +-------+       +-----------+
  41  * | mod_gadget |=====> | pipe1 |--+
  42  * +------------+       +-------+  |    +-----------+
  43  *                      | pipe2 |  |  +-| fifo dma0 |
  44  * +------------+       +-------+  |  | +-----------+
  45  * | mod_host   |       | pipe3 |<-|--+
  46  * +------------+       +-------+  |    +-----------+
  47  *                      | ....  |  +--->| fifo dma1 |
  48  *                      | ....  |       +-----------+
  49  */
  50
  51
  52 #define USBHSF_RUNTIME_PWCTRL   (1 << 0)
  53
  54 /* status */
  55 #define usbhsc_flags_init(p)   do {(p)->flags = 0; } while (0)
  56 #define usbhsc_flags_set(p, b) ((p)->flags |=  (b))
  57 #define usbhsc_flags_clr(p, b) ((p)->flags &= ~(b))
  58 #define usbhsc_flags_has(p, b) ((p)->flags &   (b))
  59
  60 /*
  61  * platform call back
  62  *
  63  * renesas usb support platform callback function.
  64  * Below macro call it.
  65  * if platform doesn't have callback, it return 0 (no error)
  66  */
  67 #define usbhs_platform_call(priv, func, args...)\
  68         (!(priv) ? -ENODEV :                    \
  69          !((priv)->pfunc.func) ? 0 :            \
  70          (priv)->pfunc.func(args))
  71
  72 /*
  73  *              common functions
  74  */
  75 u16 usbhs_read(struct usbhs_priv *priv, u32 reg)
  76 {
  77         return ioread16(priv->base + reg);
  78 }
  79
  80 void usbhs_write(struct usbhs_priv *priv, u32 reg, u16 data)
  81 {
  82         iowrite16(data, priv->base + reg);
  83 }
  84
  85 void usbhs_bset(struct usbhs_priv *priv, u32 reg, u16 mask, u16 data)
  86 {
  87         u16 val = usbhs_read(priv, reg);
  88
  89         val &= ~mask;
  90         val |= data & mask;
  91
  92         usbhs_write(priv, reg, val);
  93 }
  94
  95 struct usbhs_priv *usbhs_pdev_to_priv(struct platform_device *pdev)
  96 {
  97         return dev_get_drvdata(&pdev->dev);
  98 }
  99
 100 /*
 101  *              syscfg functions
 102  */
 103 static void usbhs_sys_clock_ctrl(struct usbhs_priv *priv, int enable)
 104 {
 105         usbhs_bset(priv, SYSCFG, SCKE, enable ? SCKE : 0);
 106 }
 107
 108 void usbhs_sys_host_ctrl(struct usbhs_priv *priv, int enable)
 109 {
 110         u16 mask = DCFM | DRPD | DPRPU | HSE | USBE;
 111         u16 val  = DCFM | DRPD | HSE | USBE;
 112         int has_otg = usbhs_get_dparam(priv, has_otg);
 113
 114         if (has_otg)
 115                 usbhs_bset(priv, DVSTCTR, (EXTLP | PWEN), (EXTLP | PWEN));
 116
 117         /*
 118          * if enable
 119          *
 120          * - select Host mode
 121          * - D+ Line/D- Line Pull-down
 122          */
 123         usbhs_bset(priv, SYSCFG, mask, enable ? val : 0);
 124 }
 125
 126 void usbhs_sys_function_ctrl(struct usbhs_priv *priv, int enable)
 127 {
 128         u16 mask = DCFM | DRPD | DPRPU | HSE | USBE;
 129         u16 val  = HSE | USBE;
 130
 131         /*
 132          * if enable
 133          *
 134          * - select Function mode
 135          * - D+ Line Pull-up is disabled
 136          *      When D+ Line Pull-up is enabled,
 137          *      calling usbhs_sys_function_pullup(,1)
 138          */
 139         usbhs_bset(priv, SYSCFG, mask, enable ? val : 0);
 140 }
 141
 142 void usbhs_sys_function_pullup(struct usbhs_priv *priv, int enable)
 143 {
 144         usbhs_bset(priv, SYSCFG, DPRPU, enable ? DPRPU : 0);
 145 }
 146
 147 void usbhs_sys_set_test_mode(struct usbhs_priv *priv, u16 mode)
 148 {
 149         usbhs_write(priv, TESTMODE, mode);
 150 }
 151
 152 /*
 153  *              frame functions
 154  */
 155 int usbhs_frame_get_num(struct usbhs_priv *priv)
 156 {
 157         return usbhs_read(priv, FRMNUM) & FRNM_MASK;
 158 }
 159
 160 /*
 161  *              usb request functions
 162  */
 163 void usbhs_usbreq_get_val(struct usbhs_priv *priv, struct usb_ctrlrequest *req)
 164 {
 165         u16 val;
 166
 167         val = usbhs_read(priv, USBREQ);
 168         req->bRequest           = (val >> 8) & 0xFF;
 169         req->bRequestType       = (val >> 0) & 0xFF;
 170
 171         req->wValue     = usbhs_read(priv, USBVAL);
 172         req->wIndex     = usbhs_read(priv, USBINDX);
 173         req->wLength    = usbhs_read(priv, USBLENG);
 174 }
 175
 176 void usbhs_usbreq_set_val(struct usbhs_priv *priv, struct usb_ctrlrequest *req)
 177 {
 178         usbhs_write(priv, USBREQ,  (req->bRequest << 8) | req->bRequestType);
 179         usbhs_write(priv, USBVAL,  req->wValue);
 180         usbhs_write(priv, USBINDX, req->wIndex);
 181         usbhs_write(priv, USBLENG, req->wLength);
 182
 183         usbhs_bset(priv, DCPCTR, SUREQ, SUREQ);
 184 }
 185
 186 /*
 187  *              bus/vbus functions
 188  */
 189 void usbhs_bus_send_sof_enable(struct usbhs_priv *priv)
 190 {
 191         u16 status = usbhs_read(priv, DVSTCTR) & (USBRST | UACT);
 192
 193         if (status != USBRST) {
 194                 struct device *dev = usbhs_priv_to_dev(priv);
 195                 dev_err(dev, "usbhs should be reset\n");
 196         }
 197
 198         usbhs_bset(priv, DVSTCTR, (USBRST | UACT), UACT);
 199 }
 200
 201 void usbhs_bus_send_reset(struct usbhs_priv *priv)
 202 {
 203         usbhs_bset(priv, DVSTCTR, (USBRST | UACT), USBRST);
 204 }
 205
 206 int usbhs_bus_get_speed(struct usbhs_priv *priv)
 207 {
 208         u16 dvstctr = usbhs_read(priv, DVSTCTR);
 209
 210         switch (RHST & dvstctr) {
 211         case RHST_LOW_SPEED:
 212                 return USB_SPEED_LOW;
 213         case RHST_FULL_SPEED:
 214                 return USB_SPEED_FULL;
 215         case RHST_HIGH_SPEED:
 216                 return USB_SPEED_HIGH;
 217         }
 218
 219         return USB_SPEED_UNKNOWN;
 220 }
 221
 222 int usbhs_vbus_ctrl(struct usbhs_priv *priv, int enable)
 223 {
 224         struct platform_device *pdev = usbhs_priv_to_pdev(priv);
 225
 226         return usbhs_platform_call(priv, set_vbus, pdev, enable);
 227 }
 228
 229 static void usbhsc_bus_init(struct usbhs_priv *priv)
 230 {
 231         usbhs_write(priv, DVSTCTR, 0);
 232
 233         usbhs_vbus_ctrl(priv, 0);
 234 }
 235
 236 /*
 237  *              device configuration
 238  */
 239 int usbhs_set_device_config(struct usbhs_priv *priv, int devnum,
 240                            u16 upphub, u16 hubport, u16 speed)
 241 {
 242         struct device *dev = usbhs_priv_to_dev(priv);
 243         u16 usbspd = 0;
 244         u32 reg = DEVADD0 + (2 * devnum);
 245
 246         if (devnum > 10) {
 247                 dev_err(dev, "cannot set speed to unknown device %d\n", devnum);
 248                 return -EIO;
 249         }
 250
 251         if (upphub > 0xA) {
 252                 dev_err(dev, "unsupported hub number %d\n", upphub);
 253                 return -EIO;
 254         }
 255
 256         switch (speed) {
 257         case USB_SPEED_LOW:
 258                 usbspd = USBSPD_SPEED_LOW;
 259                 break;
 260         case USB_SPEED_FULL:
 261                 usbspd = USBSPD_SPEED_FULL;
 262                 break;
 263         case USB_SPEED_HIGH:
 264                 usbspd = USBSPD_SPEED_HIGH;
 265                 break;
 266         default:
 267                 dev_err(dev, "unsupported speed %d\n", speed);
 268                 return -EIO;
 269         }
 270
 271         usbhs_write(priv, reg,  UPPHUB(upphub)  |
 272                                 HUBPORT(hubport)|
 273                                 USBSPD(usbspd));
 274
 275         return 0;
 276 }
 277
 278 /*
 279  *              local functions
 280  */
 281 static void usbhsc_set_buswait(struct usbhs_priv *priv)
 282 {
 283         int wait = usbhs_get_dparam(priv, buswait_bwait);
 284
 285         /* set bus wait if platform have */
 286         if (wait)
 287                 usbhs_bset(priv, BUSWAIT, 0x000F, wait);
 288 }
 289
 290 /*
 291  *              platform default param
 292  */
 293
 294 /* commonly used on old SH-Mobile SoCs */
 295 static u32 usbhsc_default_pipe_type[] = {
 296                 USB_ENDPOINT_XFER_CONTROL,
 297                 USB_ENDPOINT_XFER_ISOC,
 298                 USB_ENDPOINT_XFER_ISOC,
 299                 USB_ENDPOINT_XFER_BULK,
 300                 USB_ENDPOINT_XFER_BULK,
 301                 USB_ENDPOINT_XFER_BULK,
 302                 USB_ENDPOINT_XFER_INT,
 303                 USB_ENDPOINT_XFER_INT,
 304                 USB_ENDPOINT_XFER_INT,
 305                 USB_ENDPOINT_XFER_INT,
 306 };
 307
 308 /* commonly used on newer SH-Mobile and R-Car SoCs */
 309 static u32 usbhsc_new_pipe_type[] = {
 310                 USB_ENDPOINT_XFER_CONTROL,
 311                 USB_ENDPOINT_XFER_ISOC,
 312                 USB_ENDPOINT_XFER_ISOC,
 313                 USB_ENDPOINT_XFER_BULK,
 314                 USB_ENDPOINT_XFER_BULK,
 315                 USB_ENDPOINT_XFER_BULK,
 316                 USB_ENDPOINT_XFER_INT,
 317                 USB_ENDPOINT_XFER_INT,
 318                 USB_ENDPOINT_XFER_INT,
 319                 USB_ENDPOINT_XFER_BULK,
 320                 USB_ENDPOINT_XFER_BULK,
 321                 USB_ENDPOINT_XFER_BULK,
 322                 USB_ENDPOINT_XFER_BULK,
 323                 USB_ENDPOINT_XFER_BULK,
 324                 USB_ENDPOINT_XFER_BULK,
 325                 USB_ENDPOINT_XFER_BULK,
 326 };
 327
 328 /*
 329  *              power control
 330  */
 331 static void usbhsc_power_ctrl(struct usbhs_priv *priv, int enable)
 332 {
 333         struct platform_device *pdev = usbhs_priv_to_pdev(priv);
 334         struct device *dev = usbhs_priv_to_dev(priv);
 335
 336         if (enable) {
 337                 /* enable PM */
 338                 pm_runtime_get_sync(dev);
 339
 340                 /* enable platform power */
 341                 usbhs_platform_call(priv, power_ctrl, pdev, priv->base, enable);
 342
 343                 /* USB on */
 344                 usbhs_sys_clock_ctrl(priv, enable);
 345         } else {
 346                 /* USB off */
 347                 usbhs_sys_clock_ctrl(priv, enable);
 348
 349                 /* disable platform power */
 350                 usbhs_platform_call(priv, power_ctrl, pdev, priv->base, enable);
 351
 352                 /* disable PM */
 353                 pm_runtime_put_sync(dev);
 354         }
 355 }
 356
 357 /*
 358  *              hotplug
 359  */
 360 static void usbhsc_hotplug(struct usbhs_priv *priv)
 361 {
 362         struct platform_device *pdev = usbhs_priv_to_pdev(priv);
 363         struct usbhs_mod *mod = usbhs_mod_get_current(priv);
 364         int id;
 365         int enable;
 366         int cable;
 367         int ret;
 368
 369         /*
 370          * get vbus status from platform
 371          */
 372         enable = usbhs_platform_call(priv, get_vbus, pdev);
 373
 374         /*
 375          * get id from platform
 376          */
 377         id = usbhs_platform_call(priv, get_id, pdev);
 378
 379         if (enable && !mod) {
 380                 if (priv->edev) {
 381                         cable = extcon_get_cable_state(priv->edev, "USB-HOST");
 382                         if ((cable > 0 && id != USBHS_HOST) ||
 383                             (!cable && id != USBHS_GADGET)) {
 384                                 dev_info(&pdev->dev,
 385                                          "USB cable plugged in doesn't match the selected role!\n");
 386                                 return;
 387                         }
 388                 }
 389
 390                 ret = usbhs_mod_change(priv, id);
 391                 if (ret < 0)
 392                         return;
 393
 394                 dev_dbg(&pdev->dev, "%s enable\n", __func__);
 395
 396                 /* power on */
 397                 if (usbhsc_flags_has(priv, USBHSF_RUNTIME_PWCTRL))
 398                         usbhsc_power_ctrl(priv, enable);
 399
 400                 /* bus init */
 401                 usbhsc_set_buswait(priv);
 402                 usbhsc_bus_init(priv);
 403
 404                 /* module start */
 405                 usbhs_mod_call(priv, start, priv);
 406
 407         } else if (!enable && mod) {
 408                 dev_dbg(&pdev->dev, "%s disable\n", __func__);
 409
 410                 /* module stop */
 411                 usbhs_mod_call(priv, stop, priv);
 412
 413                 /* bus init */
 414                 usbhsc_bus_init(priv);
 415
 416                 /* power off */
 417                 if (usbhsc_flags_has(priv, USBHSF_RUNTIME_PWCTRL))
 418                         usbhsc_power_ctrl(priv, enable);
 419
 420                 usbhs_mod_change(priv, -1);
 421
 422                 /* reset phy for next connection */
 423                 usbhs_platform_call(priv, phy_reset, pdev);
 424         }
 425 }
 426
 427 /*
 428  *              notify hotplug
 429  */
 430 static void usbhsc_notify_hotplug(struct work_struct *work)
 431 {
 432         struct usbhs_priv *priv = container_of(work,
 433                                                struct usbhs_priv,
 434                                                notify_hotplug_work.work);
 435         usbhsc_hotplug(priv);
 436 }
 437
 438 static int usbhsc_drvcllbck_notify_hotplug(struct platform_device *pdev)
 439 {
 440         struct usbhs_priv *priv = usbhs_pdev_to_priv(pdev);
 441         int delay = usbhs_get_dparam(priv, detection_delay);
 442
 443         /*
 444          * This functions will be called in interrupt.
 445          * To make sure safety context,
 446          * use workqueue for usbhs_notify_hotplug
 447          */
 448         schedule_delayed_work(&priv->notify_hotplug_work,
 449                               msecs_to_jiffies(delay));
 450         return 0;
 451 }
 452
 453 /*
 454  *              platform functions
 455  */
 456 static const struct of_device_id usbhs_of_match[] = {
 457         {
 458                 .compatible = "renesas,usbhs-r8a7790",
 459                 .data = (void *)USBHS_TYPE_R8A7790,
 460         },
 461         {
 462                 .compatible = "renesas,usbhs-r8a7791",
 463                 .data = (void *)USBHS_TYPE_R8A7791,
 464         },
 465         { },
 466 };
 467 MODULE_DEVICE_TABLE(of, usbhs_of_match);
 468
 469 static struct renesas_usbhs_platform_info *usbhs_parse_dt(struct device *dev)
 470 {
 471         struct renesas_usbhs_platform_info *info;
 472         struct renesas_usbhs_driver_param *dparam;
 473         const struct of_device_id *of_id = of_match_device(usbhs_of_match, dev);
 474         u32 tmp;
 475         int gpio;
 476
 477         info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL);
 478         if (!info)
 479                 return NULL;
 480
 481         dparam = &info->driver_param;
 482         dparam->type = of_id ? (u32)of_id->data : 0;
 483         if (!of_property_read_u32(dev->of_node, "renesas,buswait", &tmp))
 484                 dparam->buswait_bwait = tmp;
 485         gpio = of_get_named_gpio_flags(dev->of_node, "renesas,enable-gpio", 0,
 486                                        NULL);
 487         if (gpio > 0)
 488                 dparam->enable_gpio = gpio;
 489
 490         return info;
 491 }
 492
 493 static int usbhs_probe(struct platform_device *pdev)
 494 {
 495         struct renesas_usbhs_platform_info *info = dev_get_platdata(&pdev->dev);
 496         struct renesas_usbhs_driver_callback *dfunc;
 497         struct usbhs_priv *priv;
 498         struct resource *res, *irq_res;
 499         int ret;
 500
 501         /* check device node */
 502         if (pdev->dev.of_node)
 503                 info = pdev->dev.platform_data = usbhs_parse_dt(&pdev->dev);
 504
 505         /* check platform information */
 506         if (!info) {
 507                 dev_err(&pdev->dev, "no platform information\n");
 508                 return -EINVAL;
 509         }
 510
 511         /* platform data */
 512         irq_res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
 513         if (!irq_res) {
 514                 dev_err(&pdev->dev, "Not enough Renesas USB platform resources.\n");
 515                 return -ENODEV;
 516         }
 517
 518         /* usb private data */
 519         priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
 520         if (!priv)
 521                 return -ENOMEM;
 522
 523         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 524         priv->base = devm_ioremap_resource(&pdev->dev, res);
 525         if (IS_ERR(priv->base))
 526                 return PTR_ERR(priv->base);
 527
 528         if (of_property_read_bool(pdev->dev.of_node, "extcon")) {
 529                 priv->edev = extcon_get_edev_by_phandle(&pdev->dev, 0);
 530                 if (IS_ERR(priv->edev))
 531                         return PTR_ERR(priv->edev);
 532         }
 533
 534         /*
 535          * care platform info
 536          */
 537
 538         memcpy(&priv->dparam,
 539                &info->driver_param,
 540                sizeof(struct renesas_usbhs_driver_param));
 541
 542         switch (priv->dparam.type) {
 543         case USBHS_TYPE_R8A7790:
 544         case USBHS_TYPE_R8A7791:
 545                 priv->pfunc = usbhs_rcar2_ops;
 546                 if (!priv->dparam.pipe_type) {
 547                         priv->dparam.pipe_type = usbhsc_new_pipe_type;
 548                         priv->dparam.pipe_size =
 549                                 ARRAY_SIZE(usbhsc_new_pipe_type);
 550                 }
 551                 break;
 552         default:
 553                 if (!info->platform_callback.get_id) {
 554                         dev_err(&pdev->dev, "no platform callbacks");
 555                         return -EINVAL;
 556                 }
 557                 memcpy(&priv->pfunc,
 558                        &info->platform_callback,
 559                        sizeof(struct renesas_usbhs_platform_callback));
 560                 break;
 561         }
 562
 563         /* set driver callback functions for platform */
 564         dfunc                   = &info->driver_callback;
 565         dfunc->notify_hotplug   = usbhsc_drvcllbck_notify_hotplug;
 566
 567         /* set default param if platform doesn't have */
 568         if (!priv->dparam.pipe_type) {
 569                 priv->dparam.pipe_type = usbhsc_default_pipe_type;
 570                 priv->dparam.pipe_size = ARRAY_SIZE(usbhsc_default_pipe_type);
 571         }
 572         if (!priv->dparam.pio_dma_border)
 573                 priv->dparam.pio_dma_border = 64; /* 64byte */
 574
 575         /* FIXME */
 576         /* runtime power control ? */
 577         if (priv->pfunc.get_vbus)
 578                 usbhsc_flags_set(priv, USBHSF_RUNTIME_PWCTRL);
 579
 580         /*
 581          * priv settings
 582          */
 583         priv->irq       = irq_res->start;
 584         if (irq_res->flags & IORESOURCE_IRQ_SHAREABLE)
 585                 priv->irqflags = IRQF_SHARED;
 586         priv->pdev      = pdev;
 587         INIT_DELAYED_WORK(&priv->notify_hotplug_work, usbhsc_notify_hotplug);
 588         spin_lock_init(usbhs_priv_to_lock(priv));
 589
 590         /* call pipe and module init */
 591         ret = usbhs_pipe_probe(priv);
 592         if (ret < 0)
 593                 return ret;
 594
 595         ret = usbhs_fifo_probe(priv);
 596         if (ret < 0)
 597                 goto probe_end_pipe_exit;
 598
 599         ret = usbhs_mod_probe(priv);
 600         if (ret < 0)
 601                 goto probe_end_fifo_exit;
 602
 603         /* dev_set_drvdata should be called after usbhs_mod_init */
 604         platform_set_drvdata(pdev, priv);
 605
 606         /*
 607          * deviece reset here because
 608          * USB device might be used in boot loader.
 609          */
 610         usbhs_sys_clock_ctrl(priv, 0);
 611
 612         /* check GPIO determining if USB function should be enabled */
 613         if (priv->dparam.enable_gpio) {
 614                 gpio_request_one(priv->dparam.enable_gpio, GPIOF_IN, NULL);
 615                 ret = !gpio_get_value(priv->dparam.enable_gpio);
 616                 gpio_free(priv->dparam.enable_gpio);
 617                 if (ret) {
 618                         dev_warn(&pdev->dev,
 619                                  "USB function not selected (GPIO %d)\n",
 620                                  priv->dparam.enable_gpio);
 621                         ret = -ENOTSUPP;
 622                         goto probe_end_mod_exit;
 623                 }
 624         }
 625
 626         /*
 627          * platform call
 628          *
 629          * USB phy setup might depend on CPU/Board.
 630          * If platform has its callback functions,
 631          * call it here.
 632          */
 633         ret = usbhs_platform_call(priv, hardware_init, pdev);
 634         if (ret < 0) {
 635                 dev_err(&pdev->dev, "platform init failed.\n");
 636                 goto probe_end_mod_exit;
 637         }
 638
 639         /* reset phy for connection */
 640         usbhs_platform_call(priv, phy_reset, pdev);
 641
 642         /* power control */
 643         pm_runtime_enable(&pdev->dev);
 644         if (!usbhsc_flags_has(priv, USBHSF_RUNTIME_PWCTRL)) {
 645                 usbhsc_power_ctrl(priv, 1);
 646                 usbhs_mod_autonomy_mode(priv);
 647         }
 648
 649         /*
 650          * manual call notify_hotplug for cold plug
 651          */
 652         usbhsc_drvcllbck_notify_hotplug(pdev);
 653
 654         dev_info(&pdev->dev, "probed\n");
 655
 656         return ret;
 657
 658 probe_end_mod_exit:
 659         usbhs_mod_remove(priv);
 660 probe_end_fifo_exit:
 661         usbhs_fifo_remove(priv);
 662 probe_end_pipe_exit:
 663         usbhs_pipe_remove(priv);
 664
 665         dev_info(&pdev->dev, "probe failed\n");
 666
 667         return ret;
 668 }
 669
 670 static int usbhs_remove(struct platform_device *pdev)
 671 {
 672         struct usbhs_priv *priv = usbhs_pdev_to_priv(pdev);
 673         struct renesas_usbhs_platform_info *info = dev_get_platdata(&pdev->dev);
 674         struct renesas_usbhs_driver_callback *dfunc = &info->driver_callback;
 675
 676         dev_dbg(&pdev->dev, "usb remove\n");
 677
 678         dfunc->notify_hotplug = NULL;
 679
 680         /* power off */
 681         if (!usbhsc_flags_has(priv, USBHSF_RUNTIME_PWCTRL))
 682                 usbhsc_power_ctrl(priv, 0);
 683
 684         pm_runtime_disable(&pdev->dev);
 685
 686         usbhs_platform_call(priv, hardware_exit, pdev);
 687         usbhs_mod_remove(priv);
 688         usbhs_fifo_remove(priv);
 689         usbhs_pipe_remove(priv);
 690
 691         return 0;
 692 }
 693
 694 static int usbhsc_suspend(struct device *dev)
 695 {
 696         struct usbhs_priv *priv = dev_get_drvdata(dev);
 697         struct usbhs_mod *mod = usbhs_mod_get_current(priv);
 698
 699         if (mod) {
 700                 usbhs_mod_call(priv, stop, priv);
 701                 usbhs_mod_change(priv, -1);
 702         }
 703
 704         if (mod || !usbhsc_flags_has(priv, USBHSF_RUNTIME_PWCTRL))
 705                 usbhsc_power_ctrl(priv, 0);
 706
 707         return 0;
 708 }
 709
 710 static int usbhsc_resume(struct device *dev)
 711 {
 712         struct usbhs_priv *priv = dev_get_drvdata(dev);
 713         struct platform_device *pdev = usbhs_priv_to_pdev(priv);
 714
 715         if (!usbhsc_flags_has(priv, USBHSF_RUNTIME_PWCTRL))
 716                 usbhsc_power_ctrl(priv, 1);
 717
 718         usbhs_platform_call(priv, phy_reset, pdev);
 719
 720         usbhsc_drvcllbck_notify_hotplug(pdev);
 721
 722         return 0;
 723 }
 724
 725 static int usbhsc_runtime_nop(struct device *dev)
 726 {
 727         /* Runtime PM callback shared between ->runtime_suspend()
 728          * and ->runtime_resume(). Simply returns success.
 729          *
 730          * This driver re-initializes all registers after
 731          * pm_runtime_get_sync() anyway so there is no need
 732          * to save and restore registers here.
 733          */
 734         return 0;
 735 }
 736
 737 static const struct dev_pm_ops usbhsc_pm_ops = {
 738         .suspend                = usbhsc_suspend,
 739         .resume                 = usbhsc_resume,
 740         .runtime_suspend        = usbhsc_runtime_nop,
 741         .runtime_resume         = usbhsc_runtime_nop,
 742 };
 743
 744 static struct platform_driver renesas_usbhs_driver = {
 745         .driver         = {
 746                 .name   = "renesas_usbhs",
 747                 .pm     = &usbhsc_pm_ops,
 748                 .of_match_table = of_match_ptr(usbhs_of_match),
 749         },
 750         .probe          = usbhs_probe,
 751         .remove         = usbhs_remove,
 752 };
 753
 754 module_platform_driver(renesas_usbhs_driver);
 755
 756 MODULE_LICENSE("GPL");
 757 MODULE_DESCRIPTION("Renesas USB driver");
 758 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");