drivers/usb/chipidea/usbmisc_imx.c

   1 /*
   2  * Copyright 2012 Freescale Semiconductor, Inc.
   3  *
   4  * The code contained herein is licensed under the GNU General Public
   5  * License. You may obtain a copy of the GNU General Public License
   6  * Version 2 or later at the following locations:
   7  *
   8  * http://www.opensource.org/licenses/gpl-license.html
   9  * http://www.gnu.org/copyleft/gpl.html
  10  */
  11
  12 #include <linux/module.h>
  13 #include <linux/of_platform.h>
  14 #include <linux/err.h>
  15 #include <linux/io.h>
  16 #include <linux/delay.h>
  17
  18 #include "ci_hdrc_imx.h"
  19
  20 #define MX25_USB_PHY_CTRL_OFFSET        0x08
  21 #define MX25_BM_EXTERNAL_VBUS_DIVIDER   BIT(23)
  22
  23 #define MX25_EHCI_INTERFACE_SINGLE_UNI  (2 << 0)
  24 #define MX25_EHCI_INTERFACE_DIFF_UNI    (0 << 0)
  25 #define MX25_EHCI_INTERFACE_MASK        (0xf)
  26
  27 #define MX25_OTG_SIC_SHIFT              29
  28 #define MX25_OTG_SIC_MASK               (0x3 << MX25_OTG_SIC_SHIFT)
  29 #define MX25_OTG_PM_BIT                 BIT(24)
  30 #define MX25_OTG_PP_BIT                 BIT(11)
  31 #define MX25_OTG_OCPOL_BIT              BIT(3)
  32
  33 #define MX25_H1_SIC_SHIFT               21
  34 #define MX25_H1_SIC_MASK                (0x3 << MX25_H1_SIC_SHIFT)
  35 #define MX25_H1_PP_BIT                  BIT(18)
  36 #define MX25_H1_PM_BIT                  BIT(16)
  37 #define MX25_H1_IPPUE_UP_BIT            BIT(7)
  38 #define MX25_H1_IPPUE_DOWN_BIT          BIT(6)
  39 #define MX25_H1_TLL_BIT                 BIT(5)
  40 #define MX25_H1_USBTE_BIT               BIT(4)
  41 #define MX25_H1_OCPOL_BIT               BIT(2)
  42
  43 #define MX27_H1_PM_BIT                  BIT(8)
  44 #define MX27_H2_PM_BIT                  BIT(16)
  45 #define MX27_OTG_PM_BIT                 BIT(24)
  46
  47 #define MX53_USB_OTG_PHY_CTRL_0_OFFSET  0x08
  48 #define MX53_USB_OTG_PHY_CTRL_1_OFFSET  0x0c
  49 #define MX53_USB_CTRL_1_OFFSET          0x10
  50 #define MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_MASK (0x11 << 2)
  51 #define MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_ULPI BIT(2)
  52 #define MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_MASK (0x11 << 6)
  53 #define MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_ULPI BIT(6)
  54 #define MX53_USB_UH2_CTRL_OFFSET        0x14
  55 #define MX53_USB_UH3_CTRL_OFFSET        0x18
  56 #define MX53_USB_CLKONOFF_CTRL_OFFSET   0x24
  57 #define MX53_USB_CLKONOFF_CTRL_H2_INT60CKOFF BIT(21)
  58 #define MX53_USB_CLKONOFF_CTRL_H3_INT60CKOFF BIT(22)
  59 #define MX53_BM_OVER_CUR_DIS_H1         BIT(5)
  60 #define MX53_BM_OVER_CUR_DIS_OTG        BIT(8)
  61 #define MX53_BM_OVER_CUR_DIS_UHx        BIT(30)
  62 #define MX53_USB_CTRL_1_UH2_ULPI_EN     BIT(26)
  63 #define MX53_USB_CTRL_1_UH3_ULPI_EN     BIT(27)
  64 #define MX53_USB_UHx_CTRL_WAKE_UP_EN    BIT(7)
  65 #define MX53_USB_UHx_CTRL_ULPI_INT_EN   BIT(8)
  66 #define MX53_USB_PHYCTRL1_PLLDIV_MASK   0x3
  67 #define MX53_USB_PLL_DIV_24_MHZ         0x01
  68
  69 #define MX6_BM_NON_BURST_SETTING        BIT(1)
  70 #define MX6_BM_OVER_CUR_DIS             BIT(7)
  71 #define MX6_BM_OVER_CUR_POLARITY        BIT(8)
  72 #define MX6_BM_WAKEUP_ENABLE            BIT(10)
  73 #define MX6_BM_ID_WAKEUP                BIT(16)
  74 #define MX6_BM_VBUS_WAKEUP              BIT(17)
  75 #define MX6SX_BM_DPDM_WAKEUP_EN         BIT(29)
  76 #define MX6_BM_WAKEUP_INTR              BIT(31)
  77 #define MX6_USB_OTG1_PHY_CTRL           0x18
  78 /* For imx6dql, it is host-only controller, for later imx6, it is otg's */
  79 #define MX6_USB_OTG2_PHY_CTRL           0x1c
  80 #define MX6SX_USB_VBUS_WAKEUP_SOURCE(v) (v << 8)
  81 #define MX6SX_USB_VBUS_WAKEUP_SOURCE_VBUS       MX6SX_USB_VBUS_WAKEUP_SOURCE(0)
  82 #define MX6SX_USB_VBUS_WAKEUP_SOURCE_AVALID     MX6SX_USB_VBUS_WAKEUP_SOURCE(1)
  83 #define MX6SX_USB_VBUS_WAKEUP_SOURCE_BVALID     MX6SX_USB_VBUS_WAKEUP_SOURCE(2)
  84 #define MX6SX_USB_VBUS_WAKEUP_SOURCE_SESS_END   MX6SX_USB_VBUS_WAKEUP_SOURCE(3)
  85
  86 #define VF610_OVER_CUR_DIS              BIT(7)
  87
  88 #define MX7D_USBNC_USB_CTRL2            0x4
  89 #define MX7D_USB_VBUS_WAKEUP_SOURCE_MASK        0x3
  90 #define MX7D_USB_VBUS_WAKEUP_SOURCE(v)          (v << 0)
  91 #define MX7D_USB_VBUS_WAKEUP_SOURCE_VBUS        MX7D_USB_VBUS_WAKEUP_SOURCE(0)
  92 #define MX7D_USB_VBUS_WAKEUP_SOURCE_AVALID      MX7D_USB_VBUS_WAKEUP_SOURCE(1)
  93 #define MX7D_USB_VBUS_WAKEUP_SOURCE_BVALID      MX7D_USB_VBUS_WAKEUP_SOURCE(2)
  94 #define MX7D_USB_VBUS_WAKEUP_SOURCE_SESS_END    MX7D_USB_VBUS_WAKEUP_SOURCE(3)
  95
  96 struct usbmisc_ops {
  97         /* It's called once when probe a usb device */
  98         int (*init)(struct imx_usbmisc_data *data);
  99         /* It's called once after adding a usb device */
 100         int (*post)(struct imx_usbmisc_data *data);
 101         /* It's called when we need to enable/disable usb wakeup */
 102         int (*set_wakeup)(struct imx_usbmisc_data *data, bool enabled);
 103 };
 104
 105 struct imx_usbmisc {
 106         void __iomem *base;
 107         spinlock_t lock;
 108         const struct usbmisc_ops *ops;
 109 };
 110
 111 static inline bool is_imx53_usbmisc(struct imx_usbmisc_data *data);
 112
 113 static int usbmisc_imx25_init(struct imx_usbmisc_data *data)
 114 {
 115         struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
 116         unsigned long flags;
 117         u32 val = 0;
 118
 119         if (data->index > 1)
 120                 return -EINVAL;
 121
 122         spin_lock_irqsave(&usbmisc->lock, flags);
 123         switch (data->index) {
 124         case 0:
 125                 val = readl(usbmisc->base);
 126                 val &= ~(MX25_OTG_SIC_MASK | MX25_OTG_PP_BIT);
 127                 val |= (MX25_EHCI_INTERFACE_DIFF_UNI & MX25_EHCI_INTERFACE_MASK) << MX25_OTG_SIC_SHIFT;
 128                 val |= (MX25_OTG_PM_BIT | MX25_OTG_OCPOL_BIT);
 129                 writel(val, usbmisc->base);
 130                 break;
 131         case 1:
 132                 val = readl(usbmisc->base);
 133                 val &= ~(MX25_H1_SIC_MASK | MX25_H1_PP_BIT |  MX25_H1_IPPUE_UP_BIT);
 134                 val |= (MX25_EHCI_INTERFACE_SINGLE_UNI & MX25_EHCI_INTERFACE_MASK) << MX25_H1_SIC_SHIFT;
 135                 val |= (MX25_H1_PM_BIT | MX25_H1_OCPOL_BIT | MX25_H1_TLL_BIT |
 136                         MX25_H1_USBTE_BIT | MX25_H1_IPPUE_DOWN_BIT);
 137
 138                 writel(val, usbmisc->base);
 139
 140                 break;
 141         }
 142         spin_unlock_irqrestore(&usbmisc->lock, flags);
 143
 144         return 0;
 145 }
 146
 147 static int usbmisc_imx25_post(struct imx_usbmisc_data *data)
 148 {
 149         struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
 150         void __iomem *reg;
 151         unsigned long flags;
 152         u32 val;
 153
 154         if (data->index > 2)
 155                 return -EINVAL;
 156
 157         if (data->evdo) {
 158                 spin_lock_irqsave(&usbmisc->lock, flags);
 159                 reg = usbmisc->base + MX25_USB_PHY_CTRL_OFFSET;
 160                 val = readl(reg);
 161                 writel(val | MX25_BM_EXTERNAL_VBUS_DIVIDER, reg);
 162                 spin_unlock_irqrestore(&usbmisc->lock, flags);
 163                 usleep_range(5000, 10000); /* needed to stabilize voltage */
 164         }
 165
 166         return 0;
 167 }
 168
 169 static int usbmisc_imx27_init(struct imx_usbmisc_data *data)
 170 {
 171         struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
 172         unsigned long flags;
 173         u32 val;
 174
 175         switch (data->index) {
 176         case 0:
 177                 val = MX27_OTG_PM_BIT;
 178                 break;
 179         case 1:
 180                 val = MX27_H1_PM_BIT;
 181                 break;
 182         case 2:
 183                 val = MX27_H2_PM_BIT;
 184                 break;
 185         default:
 186                 return -EINVAL;
 187         }
 188
 189         spin_lock_irqsave(&usbmisc->lock, flags);
 190         if (data->disable_oc)
 191                 val = readl(usbmisc->base) | val;
 192         else
 193                 val = readl(usbmisc->base) & ~val;
 194         writel(val, usbmisc->base);
 195         spin_unlock_irqrestore(&usbmisc->lock, flags);
 196
 197         return 0;
 198 }
 199
 200 static int usbmisc_imx53_init(struct imx_usbmisc_data *data)
 201 {
 202         struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
 203         void __iomem *reg = NULL;
 204         unsigned long flags;
 205         u32 val = 0;
 206
 207         if (data->index > 3)
 208                 return -EINVAL;
 209
 210         /* Select a 24 MHz reference clock for the PHY  */
 211         val = readl(usbmisc->base + MX53_USB_OTG_PHY_CTRL_1_OFFSET);
 212         val &= ~MX53_USB_PHYCTRL1_PLLDIV_MASK;
 213         val |= MX53_USB_PLL_DIV_24_MHZ;
 214         writel(val, usbmisc->base + MX53_USB_OTG_PHY_CTRL_1_OFFSET);
 215
 216         spin_lock_irqsave(&usbmisc->lock, flags);
 217
 218         switch (data->index) {
 219         case 0:
 220                 if (data->disable_oc) {
 221                         reg = usbmisc->base + MX53_USB_OTG_PHY_CTRL_0_OFFSET;
 222                         val = readl(reg) | MX53_BM_OVER_CUR_DIS_OTG;
 223                         writel(val, reg);
 224                 }
 225                 break;
 226         case 1:
 227                 if (data->disable_oc) {
 228                         reg = usbmisc->base + MX53_USB_OTG_PHY_CTRL_0_OFFSET;
 229                         val = readl(reg) | MX53_BM_OVER_CUR_DIS_H1;
 230                         writel(val, reg);
 231                 }
 232                 break;
 233         case 2:
 234                 if (data->ulpi) {
 235                         /* set USBH2 into ULPI-mode. */
 236                         reg = usbmisc->base + MX53_USB_CTRL_1_OFFSET;
 237                         val = readl(reg) | MX53_USB_CTRL_1_UH2_ULPI_EN;
 238                         /* select ULPI clock */
 239                         val &= ~MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_MASK;
 240                         val |= MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_ULPI;
 241                         writel(val, reg);
 242                         /* Set interrupt wake up enable */
 243                         reg = usbmisc->base + MX53_USB_UH2_CTRL_OFFSET;
 244                         val = readl(reg) | MX53_USB_UHx_CTRL_WAKE_UP_EN
 245                                 | MX53_USB_UHx_CTRL_ULPI_INT_EN;
 246                         writel(val, reg);
 247                         if (is_imx53_usbmisc(data)) {
 248                                 /* Disable internal 60Mhz clock */
 249                                 reg = usbmisc->base +
 250                                         MX53_USB_CLKONOFF_CTRL_OFFSET;
 251                                 val = readl(reg) |
 252                                         MX53_USB_CLKONOFF_CTRL_H2_INT60CKOFF;
 253                                 writel(val, reg);
 254                         }
 255
 256                 }
 257                 if (data->disable_oc) {
 258                         reg = usbmisc->base + MX53_USB_UH2_CTRL_OFFSET;
 259                         val = readl(reg) | MX53_BM_OVER_CUR_DIS_UHx;
 260                         writel(val, reg);
 261                 }
 262                 break;
 263         case 3:
 264                 if (data->ulpi) {
 265                         /* set USBH3 into ULPI-mode. */
 266                         reg = usbmisc->base + MX53_USB_CTRL_1_OFFSET;
 267                         val = readl(reg) | MX53_USB_CTRL_1_UH3_ULPI_EN;
 268                         /* select ULPI clock */
 269                         val &= ~MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_MASK;
 270                         val |= MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_ULPI;
 271                         writel(val, reg);
 272                         /* Set interrupt wake up enable */
 273                         reg = usbmisc->base + MX53_USB_UH3_CTRL_OFFSET;
 274                         val = readl(reg) | MX53_USB_UHx_CTRL_WAKE_UP_EN
 275                                 | MX53_USB_UHx_CTRL_ULPI_INT_EN;
 276                         writel(val, reg);
 277
 278                         if (is_imx53_usbmisc(data)) {
 279                                 /* Disable internal 60Mhz clock */
 280                                 reg = usbmisc->base +
 281                                         MX53_USB_CLKONOFF_CTRL_OFFSET;
 282                                 val = readl(reg) |
 283                                         MX53_USB_CLKONOFF_CTRL_H3_INT60CKOFF;
 284                                 writel(val, reg);
 285                         }
 286                 }
 287                 if (data->disable_oc) {
 288                         reg = usbmisc->base + MX53_USB_UH3_CTRL_OFFSET;
 289                         val = readl(reg) | MX53_BM_OVER_CUR_DIS_UHx;
 290                         writel(val, reg);
 291                 }
 292                 break;
 293         }
 294
 295         spin_unlock_irqrestore(&usbmisc->lock, flags);
 296
 297         return 0;
 298 }
 299
 300 static int usbmisc_imx6q_set_wakeup
 301         (struct imx_usbmisc_data *data, bool enabled)
 302 {
 303         struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
 304         unsigned long flags;
 305         u32 val;
 306         u32 wakeup_setting = (MX6_BM_WAKEUP_ENABLE |
 307                 MX6_BM_VBUS_WAKEUP | MX6_BM_ID_WAKEUP);
 308         int ret = 0;
 309
 310         if (data->index > 3)
 311                 return -EINVAL;
 312
 313         spin_lock_irqsave(&usbmisc->lock, flags);
 314         val = readl(usbmisc->base + data->index * 4);
 315         if (enabled) {
 316                 val |= wakeup_setting;
 317                 writel(val, usbmisc->base + data->index * 4);
 318         } else {
 319                 if (val & MX6_BM_WAKEUP_INTR)
 320                         pr_debug("wakeup int at ci_hdrc.%d\n", data->index);
 321                 val &= ~wakeup_setting;
 322                 writel(val, usbmisc->base + data->index * 4);
 323         }
 324         spin_unlock_irqrestore(&usbmisc->lock, flags);
 325
 326         return ret;
 327 }
 328
 329 static int usbmisc_imx6q_init(struct imx_usbmisc_data *data)
 330 {
 331         struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
 332         unsigned long flags;
 333         u32 reg;
 334
 335         if (data->index > 3)
 336                 return -EINVAL;
 337
 338         spin_lock_irqsave(&usbmisc->lock, flags);
 339
 340         reg = readl(usbmisc->base + data->index * 4);
 341         if (data->disable_oc) {
 342                 reg |= MX6_BM_OVER_CUR_DIS;
 343         } else if (data->oc_polarity == 1) {
 344                 /* High active */
 345                 reg &= ~(MX6_BM_OVER_CUR_DIS | MX6_BM_OVER_CUR_POLARITY);
 346         } else {
 347                 reg &= ~(MX6_BM_OVER_CUR_DIS);
 348         }
 349         writel(reg, usbmisc->base + data->index * 4);
 350
 351         /* SoC non-burst setting */
 352         reg = readl(usbmisc->base + data->index * 4);
 353         writel(reg | MX6_BM_NON_BURST_SETTING,
 354                         usbmisc->base + data->index * 4);
 355
 356         spin_unlock_irqrestore(&usbmisc->lock, flags);
 357
 358         usbmisc_imx6q_set_wakeup(data, false);
 359
 360         return 0;
 361 }
 362
 363 static int usbmisc_imx6sx_init(struct imx_usbmisc_data *data)
 364 {
 365         void __iomem *reg = NULL;
 366         unsigned long flags;
 367         struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
 368         u32 val;
 369
 370         usbmisc_imx6q_init(data);
 371
 372         if (data->index == 0 || data->index == 1) {
 373                 reg = usbmisc->base + MX6_USB_OTG1_PHY_CTRL + data->index * 4;
 374                 spin_lock_irqsave(&usbmisc->lock, flags);
 375                 /* Set vbus wakeup source as bvalid */
 376                 val = readl(reg);
 377                 writel(val | MX6SX_USB_VBUS_WAKEUP_SOURCE_BVALID, reg);
 378                 /*
 379                  * Disable dp/dm wakeup in device mode when vbus is
 380                  * not there.
 381                  */
 382                 val = readl(usbmisc->base + data->index * 4);
 383                 writel(val & ~MX6SX_BM_DPDM_WAKEUP_EN,
 384                         usbmisc->base + data->index * 4);
 385                 spin_unlock_irqrestore(&usbmisc->lock, flags);
 386         }
 387
 388         return 0;
 389 }
 390
 391 static int usbmisc_vf610_init(struct imx_usbmisc_data *data)
 392 {
 393         struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
 394         u32 reg;
 395
 396         /*
 397          * Vybrid only has one misc register set, but in two different
 398          * areas. These is reflected in two instances of this driver.
 399          */
 400         if (data->index >= 1)
 401                 return -EINVAL;
 402
 403         if (data->disable_oc) {
 404                 reg = readl(usbmisc->base);
 405                 writel(reg | VF610_OVER_CUR_DIS, usbmisc->base);
 406         }
 407
 408         return 0;
 409 }
 410
 411 static int usbmisc_imx7d_set_wakeup
 412         (struct imx_usbmisc_data *data, bool enabled)
 413 {
 414         struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
 415         unsigned long flags;
 416         u32 val;
 417         u32 wakeup_setting = (MX6_BM_WAKEUP_ENABLE |
 418                 MX6_BM_VBUS_WAKEUP | MX6_BM_ID_WAKEUP);
 419
 420         spin_lock_irqsave(&usbmisc->lock, flags);
 421         val = readl(usbmisc->base);
 422         if (enabled) {
 423                 writel(val | wakeup_setting, usbmisc->base);
 424         } else {
 425                 if (val & MX6_BM_WAKEUP_INTR)
 426                         dev_dbg(data->dev, "wakeup int\n");
 427                 writel(val & ~wakeup_setting, usbmisc->base);
 428         }
 429         spin_unlock_irqrestore(&usbmisc->lock, flags);
 430
 431         return 0;
 432 }
 433
 434 static int usbmisc_imx7d_init(struct imx_usbmisc_data *data)
 435 {
 436         struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
 437         unsigned long flags;
 438         u32 reg;
 439
 440         if (data->index >= 1)
 441                 return -EINVAL;
 442
 443         spin_lock_irqsave(&usbmisc->lock, flags);
 444         reg = readl(usbmisc->base);
 445         if (data->disable_oc) {
 446                 reg |= MX6_BM_OVER_CUR_DIS;
 447         } else if (data->oc_polarity == 1) {
 448                 /* High active */
 449                 reg &= ~(MX6_BM_OVER_CUR_DIS | MX6_BM_OVER_CUR_POLARITY);
 450         }
 451         writel(reg, usbmisc->base);
 452
 453         reg = readl(usbmisc->base + MX7D_USBNC_USB_CTRL2);
 454         reg &= ~MX7D_USB_VBUS_WAKEUP_SOURCE_MASK;
 455         writel(reg | MX7D_USB_VBUS_WAKEUP_SOURCE_BVALID,
 456                  usbmisc->base + MX7D_USBNC_USB_CTRL2);
 457         spin_unlock_irqrestore(&usbmisc->lock, flags);
 458
 459         usbmisc_imx7d_set_wakeup(data, false);
 460
 461         return 0;
 462 }
 463
 464 static const struct usbmisc_ops imx25_usbmisc_ops = {
 465         .init = usbmisc_imx25_init,
 466         .post = usbmisc_imx25_post,
 467 };
 468
 469 static const struct usbmisc_ops imx27_usbmisc_ops = {
 470         .init = usbmisc_imx27_init,
 471 };
 472
 473 static const struct usbmisc_ops imx51_usbmisc_ops = {
 474         .init = usbmisc_imx53_init,
 475 };
 476
 477 static const struct usbmisc_ops imx53_usbmisc_ops = {
 478         .init = usbmisc_imx53_init,
 479 };
 480
 481 static const struct usbmisc_ops imx6q_usbmisc_ops = {
 482         .set_wakeup = usbmisc_imx6q_set_wakeup,
 483         .init = usbmisc_imx6q_init,
 484 };
 485
 486 static const struct usbmisc_ops vf610_usbmisc_ops = {
 487         .init = usbmisc_vf610_init,
 488 };
 489
 490 static const struct usbmisc_ops imx6sx_usbmisc_ops = {
 491         .set_wakeup = usbmisc_imx6q_set_wakeup,
 492         .init = usbmisc_imx6sx_init,
 493 };
 494
 495 static const struct usbmisc_ops imx7d_usbmisc_ops = {
 496         .init = usbmisc_imx7d_init,
 497         .set_wakeup = usbmisc_imx7d_set_wakeup,
 498 };
 499
 500 static inline bool is_imx53_usbmisc(struct imx_usbmisc_data *data)
 501 {
 502         struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
 503
 504         return usbmisc->ops == &imx53_usbmisc_ops;
 505 }
 506
 507 int imx_usbmisc_init(struct imx_usbmisc_data *data)
 508 {
 509         struct imx_usbmisc *usbmisc;
 510
 511         if (!data)
 512                 return 0;
 513
 514         usbmisc = dev_get_drvdata(data->dev);
 515         if (!usbmisc->ops->init)
 516                 return 0;
 517         return usbmisc->ops->init(data);
 518 }
 519 EXPORT_SYMBOL_GPL(imx_usbmisc_init);
 520
 521 int imx_usbmisc_init_post(struct imx_usbmisc_data *data)
 522 {
 523         struct imx_usbmisc *usbmisc;
 524
 525         if (!data)
 526                 return 0;
 527
 528         usbmisc = dev_get_drvdata(data->dev);
 529         if (!usbmisc->ops->post)
 530                 return 0;
 531         return usbmisc->ops->post(data);
 532 }
 533 EXPORT_SYMBOL_GPL(imx_usbmisc_init_post);
 534
 535 int imx_usbmisc_set_wakeup(struct imx_usbmisc_data *data, bool enabled)
 536 {
 537         struct imx_usbmisc *usbmisc;
 538
 539         if (!data)
 540                 return 0;
 541
 542         usbmisc = dev_get_drvdata(data->dev);
 543         if (!usbmisc->ops->set_wakeup)
 544                 return 0;
 545         return usbmisc->ops->set_wakeup(data, enabled);
 546 }
 547 EXPORT_SYMBOL_GPL(imx_usbmisc_set_wakeup);
 548
 549 static const struct of_device_id usbmisc_imx_dt_ids[] = {
 550         {
 551                 .compatible = "fsl,imx25-usbmisc",
 552                 .data = &imx25_usbmisc_ops,
 553         },
 554         {
 555                 .compatible = "fsl,imx35-usbmisc",
 556                 .data = &imx25_usbmisc_ops,
 557         },
 558         {
 559                 .compatible = "fsl,imx27-usbmisc",
 560                 .data = &imx27_usbmisc_ops,
 561         },
 562         {
 563                 .compatible = "fsl,imx51-usbmisc",
 564                 .data = &imx51_usbmisc_ops,
 565         },
 566         {
 567                 .compatible = "fsl,imx53-usbmisc",
 568                 .data = &imx53_usbmisc_ops,
 569         },
 570         {
 571                 .compatible = "fsl,imx6q-usbmisc",
 572                 .data = &imx6q_usbmisc_ops,
 573         },
 574         {
 575                 .compatible = "fsl,vf610-usbmisc",
 576                 .data = &vf610_usbmisc_ops,
 577         },
 578         {
 579                 .compatible = "fsl,imx6sx-usbmisc",
 580                 .data = &imx6sx_usbmisc_ops,
 581         },
 582         {
 583                 .compatible = "fsl,imx6ul-usbmisc",
 584                 .data = &imx6sx_usbmisc_ops,
 585         },
 586         {
 587                 .compatible = "fsl,imx7d-usbmisc",
 588                 .data = &imx7d_usbmisc_ops,
 589         },
 590         { /* sentinel */ }
 591 };
 592 MODULE_DEVICE_TABLE(of, usbmisc_imx_dt_ids);
 593
 594 static int usbmisc_imx_probe(struct platform_device *pdev)
 595 {
 596         struct resource *res;
 597         struct imx_usbmisc *data;
 598         const struct of_device_id *of_id;
 599
 600         of_id = of_match_device(usbmisc_imx_dt_ids, &pdev->dev);
 601         if (!of_id)
 602                 return -ENODEV;
 603
 604         data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
 605         if (!data)
 606                 return -ENOMEM;
 607
 608         spin_lock_init(&data->lock);
 609
 610         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 611         data->base = devm_ioremap_resource(&pdev->dev, res);
 612         if (IS_ERR(data->base))
 613                 return PTR_ERR(data->base);
 614
 615         data->ops = (const struct usbmisc_ops *)of_id->data;
 616         platform_set_drvdata(pdev, data);
 617
 618         return 0;
 619 }
 620
 621 static int usbmisc_imx_remove(struct platform_device *pdev)
 622 {
 623         return 0;
 624 }
 625
 626 static struct platform_driver usbmisc_imx_driver = {
 627         .probe = usbmisc_imx_probe,
 628         .remove = usbmisc_imx_remove,
 629         .driver = {
 630                 .name = "usbmisc_imx",
 631                 .of_match_table = usbmisc_imx_dt_ids,
 632          },
 633 };
 634
 635 module_platform_driver(usbmisc_imx_driver);
 636
 637 MODULE_ALIAS("platform:usbmisc-imx");
 638 MODULE_LICENSE("GPL v2");
 639 MODULE_DESCRIPTION("driver for imx usb non-core registers");
 640 MODULE_AUTHOR("Richard Zhao <richard.zhao@freescale.com>");