drivers/usb/musb/omap2430.c

   1 /*
   2  * Copyright (C) 2005-2007 by Texas Instruments
   3  * Some code has been taken from tusb6010.c
   4  * Copyrights for that are attributable to:
   5  * Copyright (C) 2006 Nokia Corporation
   6  * Tony Lindgren <tony@atomide.com>
   7  *
   8  * This file is part of the Inventra Controller Driver for Linux.
   9  *
  10  * The Inventra Controller Driver for Linux is free software; you
  11  * can redistribute it and/or modify it under the terms of the GNU
  12  * General Public License version 2 as published by the Free Software
  13  * Foundation.
  14  *
  15  * The Inventra Controller Driver for Linux is distributed in
  16  * the hope that it will be useful, but WITHOUT ANY WARRANTY;
  17  * without even the implied warranty of MERCHANTABILITY or
  18  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public
  19  * License for more details.
  20  *
  21  * You should have received a copy of the GNU General Public License
  22  * along with The Inventra Controller Driver for Linux ; if not,
  23  * write to the Free Software Foundation, Inc., 59 Temple Place,
  24  * Suite 330, Boston, MA  02111-1307  USA
  25  *
  26  */
  27 #include <linux/module.h>
  28 #include <linux/kernel.h>
  29 #include <linux/sched.h>
  30 #include <linux/init.h>
  31 #include <linux/list.h>
  32 #include <linux/io.h>
  33 #include <linux/of.h>
  34 #include <linux/platform_device.h>
  35 #include <linux/dma-mapping.h>
  36 #include <linux/pm_runtime.h>
  37 #include <linux/err.h>
  38 #include <linux/delay.h>
  39 #include <linux/usb/musb.h>
  40 #include <linux/phy/omap_control_phy.h>
  41 #include <linux/of_platform.h>
  42
  43 #include "musb_core.h"
  44 #include "omap2430.h"
  45
  46 struct omap2430_glue {
  47         struct device           *dev;
  48         struct platform_device  *musb;
  49         enum musb_vbus_id_status status;
  50         struct work_struct      omap_musb_mailbox_work;
  51         struct device           *control_otghs;
  52         bool                    cable_connected;
  53         bool                    enabled;
  54         bool                    powered;
  55 };
  56 #define glue_to_musb(g)         platform_get_drvdata(g->musb)
  57
  58 static struct omap2430_glue     *_glue;
  59
  60 static void omap2430_musb_set_vbus(struct musb *musb, int is_on)
  61 {
  62         struct usb_otg  *otg = musb->xceiv->otg;
  63         u8              devctl;
  64         unsigned long timeout = jiffies + msecs_to_jiffies(1000);
  65         /* HDRC controls CPEN, but beware current surges during device
  66          * connect.  They can trigger transient overcurrent conditions
  67          * that must be ignored.
  68          */
  69
  70         devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
  71
  72         if (is_on) {
  73                 if (musb->xceiv->otg->state == OTG_STATE_A_IDLE) {
  74                         int loops = 100;
  75                         /* start the session */
  76                         devctl |= MUSB_DEVCTL_SESSION;
  77                         musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
  78                         /*
  79                          * Wait for the musb to set as A device to enable the
  80                          * VBUS
  81                          */
  82                         while (musb_readb(musb->mregs, MUSB_DEVCTL) &
  83                                MUSB_DEVCTL_BDEVICE) {
  84
  85                                 mdelay(5);
  86                                 cpu_relax();
  87
  88                                 if (time_after(jiffies, timeout)
  89                                     || loops-- <= 0) {
  90                                         dev_err(musb->controller,
  91                                         "configured as A device timeout");
  92                                         break;
  93                                 }
  94                         }
  95
  96                         otg_set_vbus(otg, 1);
  97                 } else {
  98                         musb->is_active = 1;
  99                         otg->default_a = 1;
 100                         musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
 101                         devctl |= MUSB_DEVCTL_SESSION;
 102                         MUSB_HST_MODE(musb);
 103                 }
 104         } else {
 105                 musb->is_active = 0;
 106
 107                 /* NOTE:  we're skipping A_WAIT_VFALL -> A_IDLE and
 108                  * jumping right to B_IDLE...
 109                  */
 110
 111                 otg->default_a = 0;
 112                 musb->xceiv->otg->state = OTG_STATE_B_IDLE;
 113                 devctl &= ~MUSB_DEVCTL_SESSION;
 114
 115                 MUSB_DEV_MODE(musb);
 116         }
 117         musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
 118
 119         dev_dbg(musb->controller, "VBUS %s, devctl %02x "
 120                 /* otg %3x conf %08x prcm %08x */ "\n",
 121                 usb_otg_state_string(musb->xceiv->otg->state),
 122                 musb_readb(musb->mregs, MUSB_DEVCTL));
 123 }
 124
 125 static inline void omap2430_low_level_exit(struct musb *musb)
 126 {
 127         u32 l;
 128
 129         /* in any role */
 130         l = musb_readl(musb->mregs, OTG_FORCESTDBY);
 131         l |= ENABLEFORCE;       /* enable MSTANDBY */
 132         musb_writel(musb->mregs, OTG_FORCESTDBY, l);
 133 }
 134
 135 static inline void omap2430_low_level_init(struct musb *musb)
 136 {
 137         u32 l;
 138
 139         l = musb_readl(musb->mregs, OTG_FORCESTDBY);
 140         l &= ~ENABLEFORCE;      /* disable MSTANDBY */
 141         musb_writel(musb->mregs, OTG_FORCESTDBY, l);
 142 }
 143
 144 /*
 145  * We can get multiple cable events so we need to keep track
 146  * of the power state. Only keep power enabled if USB cable is
 147  * connected and a gadget is started.
 148  */
 149 static void omap2430_set_power(struct musb *musb, bool enabled, bool cable)
 150 {
 151         struct device *dev = musb->controller;
 152         struct omap2430_glue *glue = dev_get_drvdata(dev->parent);
 153         bool power_up;
 154         int res;
 155
 156         if (glue->enabled != enabled)
 157                 glue->enabled = enabled;
 158
 159         if (glue->cable_connected != cable)
 160                 glue->cable_connected = cable;
 161
 162         power_up = glue->enabled && glue->cable_connected;
 163         if (power_up == glue->powered) {
 164                 dev_warn(musb->controller, "power state already %i\n",
 165                          power_up);
 166                 return;
 167         }
 168
 169         glue->powered = power_up;
 170
 171         if (power_up) {
 172                 res = pm_runtime_get_sync(musb->controller);
 173                 if (res < 0) {
 174                         dev_err(musb->controller, "could not enable: %i", res);
 175                         glue->powered = false;
 176                 }
 177         } else {
 178                 pm_runtime_mark_last_busy(musb->controller);
 179                 pm_runtime_put_autosuspend(musb->controller);
 180         }
 181 }
 182
 183 static int omap2430_musb_mailbox(enum musb_vbus_id_status status)
 184 {
 185         struct omap2430_glue    *glue = _glue;
 186
 187         if (!glue) {
 188                 pr_err("%s: musb core is not yet initialized\n", __func__);
 189                 return -EPROBE_DEFER;
 190         }
 191         glue->status = status;
 192
 193         if (!glue_to_musb(glue)) {
 194                 pr_err("%s: musb core is not yet ready\n", __func__);
 195                 return -EPROBE_DEFER;
 196         }
 197
 198         schedule_work(&glue->omap_musb_mailbox_work);
 199
 200         return 0;
 201 }
 202
 203 static void omap_musb_set_mailbox(struct omap2430_glue *glue)
 204 {
 205         struct musb *musb = glue_to_musb(glue);
 206         struct device *dev = musb->controller;
 207         struct musb_hdrc_platform_data *pdata = dev_get_platdata(dev);
 208         struct omap_musb_board_data *data = pdata->board_data;
 209         struct usb_otg *otg = musb->xceiv->otg;
 210         bool cable_connected;
 211
 212         cable_connected = ((glue->status == MUSB_ID_GROUND) ||
 213                            (glue->status == MUSB_VBUS_VALID));
 214
 215         if (cable_connected)
 216                 omap2430_set_power(musb, glue->enabled, cable_connected);
 217
 218         switch (glue->status) {
 219         case MUSB_ID_GROUND:
 220                 dev_dbg(dev, "ID GND\n");
 221
 222                 otg->default_a = true;
 223                 musb->xceiv->otg->state = OTG_STATE_A_IDLE;
 224                 musb->xceiv->last_event = USB_EVENT_ID;
 225                 if (musb->gadget_driver) {
 226                         omap_control_usb_set_mode(glue->control_otghs,
 227                                 USB_MODE_HOST);
 228                         omap2430_musb_set_vbus(musb, 1);
 229                 }
 230                 break;
 231
 232         case MUSB_VBUS_VALID:
 233                 dev_dbg(dev, "VBUS Connect\n");
 234
 235                 otg->default_a = false;
 236                 musb->xceiv->otg->state = OTG_STATE_B_IDLE;
 237                 musb->xceiv->last_event = USB_EVENT_VBUS;
 238                 omap_control_usb_set_mode(glue->control_otghs, USB_MODE_DEVICE);
 239                 break;
 240
 241         case MUSB_ID_FLOAT:
 242         case MUSB_VBUS_OFF:
 243                 dev_dbg(dev, "VBUS Disconnect\n");
 244
 245                 musb->xceiv->last_event = USB_EVENT_NONE;
 246                 if (musb->gadget_driver)
 247                         omap2430_musb_set_vbus(musb, 0);
 248
 249                 if (data->interface_type == MUSB_INTERFACE_UTMI)
 250                         otg_set_vbus(musb->xceiv->otg, 0);
 251
 252                 omap_control_usb_set_mode(glue->control_otghs,
 253                         USB_MODE_DISCONNECT);
 254                 break;
 255         default:
 256                 dev_dbg(dev, "ID float\n");
 257         }
 258
 259         if (!cable_connected)
 260                 omap2430_set_power(musb, glue->enabled, cable_connected);
 261
 262         atomic_notifier_call_chain(&musb->xceiv->notifier,
 263                         musb->xceiv->last_event, NULL);
 264 }
 265
 266
 267 static void omap_musb_mailbox_work(struct work_struct *mailbox_work)
 268 {
 269         struct omap2430_glue *glue = container_of(mailbox_work,
 270                                 struct omap2430_glue, omap_musb_mailbox_work);
 271         struct musb *musb = glue_to_musb(glue);
 272         struct device *dev = musb->controller;
 273
 274         pm_runtime_get_sync(dev);
 275         omap_musb_set_mailbox(glue);
 276         pm_runtime_mark_last_busy(dev);
 277         pm_runtime_put_autosuspend(dev);
 278 }
 279
 280 static irqreturn_t omap2430_musb_interrupt(int irq, void *__hci)
 281 {
 282         unsigned long   flags;
 283         irqreturn_t     retval = IRQ_NONE;
 284         struct musb     *musb = __hci;
 285
 286         spin_lock_irqsave(&musb->lock, flags);
 287
 288         musb->int_usb = musb_readb(musb->mregs, MUSB_INTRUSB);
 289         musb->int_tx = musb_readw(musb->mregs, MUSB_INTRTX);
 290         musb->int_rx = musb_readw(musb->mregs, MUSB_INTRRX);
 291
 292         if (musb->int_usb || musb->int_tx || musb->int_rx)
 293                 retval = musb_interrupt(musb);
 294
 295         spin_unlock_irqrestore(&musb->lock, flags);
 296
 297         return retval;
 298 }
 299
 300 static int omap2430_musb_init(struct musb *musb)
 301 {
 302         u32 l;
 303         int status = 0;
 304         struct device *dev = musb->controller;
 305         struct omap2430_glue *glue = dev_get_drvdata(dev->parent);
 306         struct musb_hdrc_platform_data *plat = dev_get_platdata(dev);
 307         struct omap_musb_board_data *data = plat->board_data;
 308
 309         /* We require some kind of external transceiver, hooked
 310          * up through ULPI.  TWL4030-family PMICs include one,
 311          * which needs a driver, drivers aren't always needed.
 312          */
 313         if (dev->parent->of_node) {
 314                 musb->phy = devm_phy_get(dev->parent, "usb2-phy");
 315
 316                 /* We can't totally remove musb->xceiv as of now because
 317                  * musb core uses xceiv.state and xceiv.otg. Once we have
 318                  * a separate state machine to handle otg, these can be moved
 319                  * out of xceiv and then we can start using the generic PHY
 320                  * framework
 321                  */
 322                 musb->xceiv = devm_usb_get_phy_by_phandle(dev->parent,
 323                     "usb-phy", 0);
 324         } else {
 325                 musb->xceiv = devm_usb_get_phy_dev(dev, 0);
 326                 musb->phy = devm_phy_get(dev, "usb");
 327         }
 328
 329         if (IS_ERR(musb->xceiv)) {
 330                 status = PTR_ERR(musb->xceiv);
 331
 332                 if (status == -ENXIO)
 333                         return status;
 334
 335                 pr_err("HS USB OTG: no transceiver configured\n");
 336                 return -EPROBE_DEFER;
 337         }
 338
 339         if (IS_ERR(musb->phy)) {
 340                 pr_err("HS USB OTG: no PHY configured\n");
 341                 return PTR_ERR(musb->phy);
 342         }
 343         musb->isr = omap2430_musb_interrupt;
 344         phy_init(musb->phy);
 345
 346         /*
 347          * Enable runtime PM for musb parent (this driver). We can't
 348          * do it earlier as struct musb is not yet allocated and we
 349          * need to touch the musb registers for runtime PM.
 350          */
 351         pm_runtime_enable(glue->dev);
 352         status = pm_runtime_get_sync(glue->dev);
 353         if (status < 0)
 354                 goto err1;
 355
 356         l = musb_readl(musb->mregs, OTG_INTERFSEL);
 357
 358         if (data->interface_type == MUSB_INTERFACE_UTMI) {
 359                 /* OMAP4 uses Internal PHY GS70 which uses UTMI interface */
 360                 l &= ~ULPI_12PIN;       /* Disable ULPI */
 361                 l |= UTMI_8BIT;         /* Enable UTMI  */
 362         } else {
 363                 l |= ULPI_12PIN;
 364         }
 365
 366         musb_writel(musb->mregs, OTG_INTERFSEL, l);
 367
 368         pr_debug("HS USB OTG: revision 0x%x, sysconfig 0x%02x, "
 369                         "sysstatus 0x%x, intrfsel 0x%x, simenable  0x%x\n",
 370                         musb_readl(musb->mregs, OTG_REVISION),
 371                         musb_readl(musb->mregs, OTG_SYSCONFIG),
 372                         musb_readl(musb->mregs, OTG_SYSSTATUS),
 373                         musb_readl(musb->mregs, OTG_INTERFSEL),
 374                         musb_readl(musb->mregs, OTG_SIMENABLE));
 375
 376         if (glue->status != MUSB_UNKNOWN)
 377                 omap_musb_set_mailbox(glue);
 378
 379         pm_runtime_put(glue->dev);
 380         return 0;
 381
 382 err1:
 383         return status;
 384 }
 385
 386 static void omap2430_musb_enable(struct musb *musb)
 387 {
 388         u8              devctl;
 389         unsigned long timeout = jiffies + msecs_to_jiffies(1000);
 390         struct device *dev = musb->controller;
 391         struct omap2430_glue *glue = dev_get_drvdata(dev->parent);
 392         struct musb_hdrc_platform_data *pdata = dev_get_platdata(dev);
 393         struct omap_musb_board_data *data = pdata->board_data;
 394
 395         if (!WARN_ON(!musb->phy))
 396                 phy_power_on(musb->phy);
 397
 398         omap2430_set_power(musb, true, glue->cable_connected);
 399
 400         switch (glue->status) {
 401
 402         case MUSB_ID_GROUND:
 403                 omap_control_usb_set_mode(glue->control_otghs, USB_MODE_HOST);
 404                 if (data->interface_type != MUSB_INTERFACE_UTMI)
 405                         break;
 406                 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
 407                 /* start the session */
 408                 devctl |= MUSB_DEVCTL_SESSION;
 409                 musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
 410                 while (musb_readb(musb->mregs, MUSB_DEVCTL) &
 411                                 MUSB_DEVCTL_BDEVICE) {
 412                         cpu_relax();
 413
 414                         if (time_after(jiffies, timeout)) {
 415                                 dev_err(dev, "configured as A device timeout");
 416                                 break;
 417                         }
 418                 }
 419                 break;
 420
 421         case MUSB_VBUS_VALID:
 422                 omap_control_usb_set_mode(glue->control_otghs, USB_MODE_DEVICE);
 423                 break;
 424
 425         default:
 426                 break;
 427         }
 428 }
 429
 430 static void omap2430_musb_disable(struct musb *musb)
 431 {
 432         struct device *dev = musb->controller;
 433         struct omap2430_glue *glue = dev_get_drvdata(dev->parent);
 434
 435         if (!WARN_ON(!musb->phy))
 436                 phy_power_off(musb->phy);
 437
 438         if (glue->status != MUSB_UNKNOWN)
 439                 omap_control_usb_set_mode(glue->control_otghs,
 440                         USB_MODE_DISCONNECT);
 441
 442         omap2430_set_power(musb, false, glue->cable_connected);
 443 }
 444
 445 static int omap2430_musb_exit(struct musb *musb)
 446 {
 447         struct device *dev = musb->controller;
 448         struct omap2430_glue *glue = dev_get_drvdata(dev->parent);
 449
 450         omap2430_low_level_exit(musb);
 451         phy_exit(musb->phy);
 452         musb->phy = NULL;
 453         cancel_work_sync(&glue->omap_musb_mailbox_work);
 454
 455         return 0;
 456 }
 457
 458 static const struct musb_platform_ops omap2430_ops = {
 459         .quirks         = MUSB_DMA_INVENTRA,
 460 #ifdef CONFIG_USB_INVENTRA_DMA
 461         .dma_init       = musbhs_dma_controller_create,
 462         .dma_exit       = musbhs_dma_controller_destroy,
 463 #endif
 464         .init           = omap2430_musb_init,
 465         .exit           = omap2430_musb_exit,
 466
 467         .set_vbus       = omap2430_musb_set_vbus,
 468
 469         .enable         = omap2430_musb_enable,
 470         .disable        = omap2430_musb_disable,
 471
 472         .phy_callback   = omap2430_musb_mailbox,
 473 };
 474
 475 static u64 omap2430_dmamask = DMA_BIT_MASK(32);
 476
 477 static int omap2430_probe(struct platform_device *pdev)
 478 {
 479         struct resource                 musb_resources[3];
 480         struct musb_hdrc_platform_data  *pdata = dev_get_platdata(&pdev->dev);
 481         struct omap_musb_board_data     *data;
 482         struct platform_device          *musb;
 483         struct omap2430_glue            *glue;
 484         struct device_node              *np = pdev->dev.of_node;
 485         struct musb_hdrc_config         *config;
 486         int                             ret = -ENOMEM, val;
 487
 488         glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL);
 489         if (!glue)
 490                 goto err0;
 491
 492         musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
 493         if (!musb) {
 494                 dev_err(&pdev->dev, "failed to allocate musb device\n");
 495                 goto err0;
 496         }
 497
 498         musb->dev.parent                = &pdev->dev;
 499         musb->dev.dma_mask              = &omap2430_dmamask;
 500         musb->dev.coherent_dma_mask     = omap2430_dmamask;
 501
 502         glue->dev                       = &pdev->dev;
 503         glue->musb                      = musb;
 504         glue->status                    = MUSB_UNKNOWN;
 505         glue->control_otghs = ERR_PTR(-ENODEV);
 506
 507         if (np) {
 508                 struct device_node *control_node;
 509                 struct platform_device *control_pdev;
 510
 511                 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
 512                 if (!pdata)
 513                         goto err2;
 514
 515                 data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
 516                 if (!data)
 517                         goto err2;
 518
 519                 config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL);
 520                 if (!config)
 521                         goto err2;
 522
 523                 of_property_read_u32(np, "mode", (u32 *)&pdata->mode);
 524                 of_property_read_u32(np, "interface-type",
 525                                                 (u32 *)&data->interface_type);
 526                 of_property_read_u32(np, "num-eps", (u32 *)&config->num_eps);
 527                 of_property_read_u32(np, "ram-bits", (u32 *)&config->ram_bits);
 528                 of_property_read_u32(np, "power", (u32 *)&pdata->power);
 529
 530                 ret = of_property_read_u32(np, "multipoint", &val);
 531                 if (!ret && val)
 532                         config->multipoint = true;
 533
 534                 pdata->board_data       = data;
 535                 pdata->config           = config;
 536
 537                 control_node = of_parse_phandle(np, "ctrl-module", 0);
 538                 if (control_node) {
 539                         control_pdev = of_find_device_by_node(control_node);
 540                         if (!control_pdev) {
 541                                 dev_err(&pdev->dev, "Failed to get control device\n");
 542                                 ret = -EINVAL;
 543                                 goto err2;
 544                         }
 545                         glue->control_otghs = &control_pdev->dev;
 546                 }
 547         }
 548         pdata->platform_ops             = &omap2430_ops;
 549
 550         platform_set_drvdata(pdev, glue);
 551
 552         /*
 553          * REVISIT if we ever have two instances of the wrapper, we will be
 554          * in big trouble
 555          */
 556         _glue   = glue;
 557
 558         INIT_WORK(&glue->omap_musb_mailbox_work, omap_musb_mailbox_work);
 559
 560         memset(musb_resources, 0x00, sizeof(*musb_resources) *
 561                         ARRAY_SIZE(musb_resources));
 562
 563         musb_resources[0].name = pdev->resource[0].name;
 564         musb_resources[0].start = pdev->resource[0].start;
 565         musb_resources[0].end = pdev->resource[0].end;
 566         musb_resources[0].flags = pdev->resource[0].flags;
 567
 568         musb_resources[1].name = pdev->resource[1].name;
 569         musb_resources[1].start = pdev->resource[1].start;
 570         musb_resources[1].end = pdev->resource[1].end;
 571         musb_resources[1].flags = pdev->resource[1].flags;
 572
 573         musb_resources[2].name = pdev->resource[2].name;
 574         musb_resources[2].start = pdev->resource[2].start;
 575         musb_resources[2].end = pdev->resource[2].end;
 576         musb_resources[2].flags = pdev->resource[2].flags;
 577
 578         ret = platform_device_add_resources(musb, musb_resources,
 579                         ARRAY_SIZE(musb_resources));
 580         if (ret) {
 581                 dev_err(&pdev->dev, "failed to add resources\n");
 582                 goto err2;
 583         }
 584
 585         ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
 586         if (ret) {
 587                 dev_err(&pdev->dev, "failed to add platform_data\n");
 588                 goto err2;
 589         }
 590
 591         /*
 592          * Note that we cannot enable PM runtime yet for this
 593          * driver as we need struct musb initialized first.
 594          * See omap2430_musb_init above.
 595          */
 596
 597         ret = platform_device_add(musb);
 598         if (ret) {
 599                 dev_err(&pdev->dev, "failed to register musb device\n");
 600                 goto err2;
 601         }
 602
 603         return 0;
 604
 605 err2:
 606         platform_device_put(musb);
 607
 608 err0:
 609         return ret;
 610 }
 611
 612 static int omap2430_remove(struct platform_device *pdev)
 613 {
 614         struct omap2430_glue *glue = platform_get_drvdata(pdev);
 615         struct musb *musb = glue_to_musb(glue);
 616
 617         pm_runtime_get_sync(glue->dev);
 618         platform_device_unregister(glue->musb);
 619         omap2430_set_power(musb, false, false);
 620         pm_runtime_put_sync(glue->dev);
 621         pm_runtime_disable(glue->dev);
 622
 623         return 0;
 624 }
 625
 626 #ifdef CONFIG_PM
 627
 628 static int omap2430_runtime_suspend(struct device *dev)
 629 {
 630         struct omap2430_glue            *glue = dev_get_drvdata(dev);
 631         struct musb                     *musb = glue_to_musb(glue);
 632
 633         if (!musb)
 634                 return 0;
 635
 636         musb->context.otg_interfsel = musb_readl(musb->mregs,
 637                                                  OTG_INTERFSEL);
 638
 639         omap2430_low_level_exit(musb);
 640
 641         return 0;
 642 }
 643
 644 static int omap2430_runtime_resume(struct device *dev)
 645 {
 646         struct omap2430_glue            *glue = dev_get_drvdata(dev);
 647         struct musb                     *musb = glue_to_musb(glue);
 648
 649         if (!musb)
 650                 return 0;
 651
 652         omap2430_low_level_init(musb);
 653         musb_writel(musb->mregs, OTG_INTERFSEL,
 654                     musb->context.otg_interfsel);
 655
 656         return 0;
 657 }
 658
 659 static struct dev_pm_ops omap2430_pm_ops = {
 660         .runtime_suspend = omap2430_runtime_suspend,
 661         .runtime_resume = omap2430_runtime_resume,
 662 };
 663
 664 #define DEV_PM_OPS      (&omap2430_pm_ops)
 665 #else
 666 #define DEV_PM_OPS      NULL
 667 #endif
 668
 669 #ifdef CONFIG_OF
 670 static const struct of_device_id omap2430_id_table[] = {
 671         {
 672                 .compatible = "ti,omap4-musb"
 673         },
 674         {
 675                 .compatible = "ti,omap3-musb"
 676         },
 677         {},
 678 };
 679 MODULE_DEVICE_TABLE(of, omap2430_id_table);
 680 #endif
 681
 682 static struct platform_driver omap2430_driver = {
 683         .probe          = omap2430_probe,
 684         .remove         = omap2430_remove,
 685         .driver         = {
 686                 .name   = "musb-omap2430",
 687                 .pm     = DEV_PM_OPS,
 688                 .of_match_table = of_match_ptr(omap2430_id_table),
 689         },
 690 };
 691
 692 MODULE_DESCRIPTION("OMAP2PLUS MUSB Glue Layer");
 693 MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
 694 MODULE_LICENSE("GPL v2");
 695
 696 static int __init omap2430_init(void)
 697 {
 698         return platform_driver_register(&omap2430_driver);
 699 }
 700 subsys_initcall(omap2430_init);
 701
 702 static void __exit omap2430_exit(void)
 703 {
 704         platform_driver_unregister(&omap2430_driver);
 705 }
 706 module_exit(omap2430_exit);