drivers/usb/renesas_usbhs/common.c

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