1 /* 2 * TUSB6010 USB 2.0 OTG Dual Role controller 3 * 4 * Copyright (C) 2006 Nokia Corporation 5 * Tony Lindgren <tony@atomide.com> 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License version 2 as 9 * published by the Free Software Foundation. 10 * 11 * Notes: 12 * - Driver assumes that interface to external host (main CPU) is 13 * configured for NOR FLASH interface instead of VLYNQ serial 14 * interface. 15 */ 16 17 #include <linux/module.h> 18 #include <linux/kernel.h> 19 #include <linux/errno.h> 20 #include <linux/err.h> 21 #include <linux/prefetch.h> 22 #include <linux/usb.h> 23 #include <linux/irq.h> 24 #include <linux/io.h> 25 #include <linux/device.h> 26 #include <linux/platform_device.h> 27 #include <linux/dma-mapping.h> 28 #include <linux/usb/usb_phy_generic.h> 29 30 #include "musb_core.h" 31 32 struct tusb6010_glue { 33 struct device *dev; 34 struct platform_device *musb; 35 struct platform_device *phy; 36 }; 37 38 static void tusb_musb_set_vbus(struct musb *musb, int is_on); 39 40 #define TUSB_REV_MAJOR(reg_val) ((reg_val >> 4) & 0xf) 41 #define TUSB_REV_MINOR(reg_val) (reg_val & 0xf) 42 43 /* 44 * Checks the revision. We need to use the DMA register as 3.0 does not 45 * have correct versions for TUSB_PRCM_REV or TUSB_INT_CTRL_REV. 46 */ 47 static u8 tusb_get_revision(struct musb *musb) 48 { 49 void __iomem *tbase = musb->ctrl_base; 50 u32 die_id; 51 u8 rev; 52 53 rev = musb_readl(tbase, TUSB_DMA_CTRL_REV) & 0xff; 54 if (TUSB_REV_MAJOR(rev) == 3) { 55 die_id = TUSB_DIDR1_HI_CHIP_REV(musb_readl(tbase, 56 TUSB_DIDR1_HI)); 57 if (die_id >= TUSB_DIDR1_HI_REV_31) 58 rev |= 1; 59 } 60 61 return rev; 62 } 63 64 static void tusb_print_revision(struct musb *musb) 65 { 66 void __iomem *tbase = musb->ctrl_base; 67 u8 rev; 68 69 rev = musb->tusb_revision; 70 71 pr_info("tusb: %s%i.%i %s%i.%i %s%i.%i %s%i.%i %s%i %s%i.%i\n", 72 "prcm", 73 TUSB_REV_MAJOR(musb_readl(tbase, TUSB_PRCM_REV)), 74 TUSB_REV_MINOR(musb_readl(tbase, TUSB_PRCM_REV)), 75 "int", 76 TUSB_REV_MAJOR(musb_readl(tbase, TUSB_INT_CTRL_REV)), 77 TUSB_REV_MINOR(musb_readl(tbase, TUSB_INT_CTRL_REV)), 78 "gpio", 79 TUSB_REV_MAJOR(musb_readl(tbase, TUSB_GPIO_REV)), 80 TUSB_REV_MINOR(musb_readl(tbase, TUSB_GPIO_REV)), 81 "dma", 82 TUSB_REV_MAJOR(musb_readl(tbase, TUSB_DMA_CTRL_REV)), 83 TUSB_REV_MINOR(musb_readl(tbase, TUSB_DMA_CTRL_REV)), 84 "dieid", 85 TUSB_DIDR1_HI_CHIP_REV(musb_readl(tbase, TUSB_DIDR1_HI)), 86 "rev", 87 TUSB_REV_MAJOR(rev), TUSB_REV_MINOR(rev)); 88 } 89 90 #define WBUS_QUIRK_MASK (TUSB_PHY_OTG_CTRL_TESTM2 | TUSB_PHY_OTG_CTRL_TESTM1 \ 91 | TUSB_PHY_OTG_CTRL_TESTM0) 92 93 /* 94 * Workaround for spontaneous WBUS wake-up issue #2 for tusb3.0. 95 * Disables power detection in PHY for the duration of idle. 96 */ 97 static void tusb_wbus_quirk(struct musb *musb, int enabled) 98 { 99 void __iomem *tbase = musb->ctrl_base; 100 static u32 phy_otg_ctrl, phy_otg_ena; 101 u32 tmp; 102 103 if (enabled) { 104 phy_otg_ctrl = musb_readl(tbase, TUSB_PHY_OTG_CTRL); 105 phy_otg_ena = musb_readl(tbase, TUSB_PHY_OTG_CTRL_ENABLE); 106 tmp = TUSB_PHY_OTG_CTRL_WRPROTECT 107 | phy_otg_ena | WBUS_QUIRK_MASK; 108 musb_writel(tbase, TUSB_PHY_OTG_CTRL, tmp); 109 tmp = phy_otg_ena & ~WBUS_QUIRK_MASK; 110 tmp |= TUSB_PHY_OTG_CTRL_WRPROTECT | TUSB_PHY_OTG_CTRL_TESTM2; 111 musb_writel(tbase, TUSB_PHY_OTG_CTRL_ENABLE, tmp); 112 dev_dbg(musb->controller, "Enabled tusb wbus quirk ctrl %08x ena %08x\n", 113 musb_readl(tbase, TUSB_PHY_OTG_CTRL), 114 musb_readl(tbase, TUSB_PHY_OTG_CTRL_ENABLE)); 115 } else if (musb_readl(tbase, TUSB_PHY_OTG_CTRL_ENABLE) 116 & TUSB_PHY_OTG_CTRL_TESTM2) { 117 tmp = TUSB_PHY_OTG_CTRL_WRPROTECT | phy_otg_ctrl; 118 musb_writel(tbase, TUSB_PHY_OTG_CTRL, tmp); 119 tmp = TUSB_PHY_OTG_CTRL_WRPROTECT | phy_otg_ena; 120 musb_writel(tbase, TUSB_PHY_OTG_CTRL_ENABLE, tmp); 121 dev_dbg(musb->controller, "Disabled tusb wbus quirk ctrl %08x ena %08x\n", 122 musb_readl(tbase, TUSB_PHY_OTG_CTRL), 123 musb_readl(tbase, TUSB_PHY_OTG_CTRL_ENABLE)); 124 phy_otg_ctrl = 0; 125 phy_otg_ena = 0; 126 } 127 } 128 129 static u32 tusb_fifo_offset(u8 epnum) 130 { 131 return 0x200 + (epnum * 0x20); 132 } 133 134 static u32 tusb_ep_offset(u8 epnum, u16 offset) 135 { 136 return 0x10 + offset; 137 } 138 139 /* TUSB mapping: "flat" plus ep0 special cases */ 140 static void tusb_ep_select(void __iomem *mbase, u8 epnum) 141 { 142 musb_writeb(mbase, MUSB_INDEX, epnum); 143 } 144 145 /* 146 * TUSB6010 doesn't allow 8-bit access; 16-bit access is the minimum. 147 */ 148 static u8 tusb_readb(const void __iomem *addr, unsigned offset) 149 { 150 u16 tmp; 151 u8 val; 152 153 tmp = __raw_readw(addr + (offset & ~1)); 154 if (offset & 1) 155 val = (tmp >> 8); 156 else 157 val = tmp & 0xff; 158 159 return val; 160 } 161 162 static void tusb_writeb(void __iomem *addr, unsigned offset, u8 data) 163 { 164 u16 tmp; 165 166 tmp = __raw_readw(addr + (offset & ~1)); 167 if (offset & 1) 168 tmp = (data << 8) | (tmp & 0xff); 169 else 170 tmp = (tmp & 0xff00) | data; 171 172 __raw_writew(tmp, addr + (offset & ~1)); 173 } 174 175 /* 176 * TUSB 6010 may use a parallel bus that doesn't support byte ops; 177 * so both loading and unloading FIFOs need explicit byte counts. 178 */ 179 180 static inline void 181 tusb_fifo_write_unaligned(void __iomem *fifo, const u8 *buf, u16 len) 182 { 183 u32 val; 184 int i; 185 186 if (len > 4) { 187 for (i = 0; i < (len >> 2); i++) { 188 memcpy(&val, buf, 4); 189 musb_writel(fifo, 0, val); 190 buf += 4; 191 } 192 len %= 4; 193 } 194 if (len > 0) { 195 /* Write the rest 1 - 3 bytes to FIFO */ 196 memcpy(&val, buf, len); 197 musb_writel(fifo, 0, val); 198 } 199 } 200 201 static inline void tusb_fifo_read_unaligned(void __iomem *fifo, 202 void *buf, u16 len) 203 { 204 u32 val; 205 int i; 206 207 if (len > 4) { 208 for (i = 0; i < (len >> 2); i++) { 209 val = musb_readl(fifo, 0); 210 memcpy(buf, &val, 4); 211 buf += 4; 212 } 213 len %= 4; 214 } 215 if (len > 0) { 216 /* Read the rest 1 - 3 bytes from FIFO */ 217 val = musb_readl(fifo, 0); 218 memcpy(buf, &val, len); 219 } 220 } 221 222 static void tusb_write_fifo(struct musb_hw_ep *hw_ep, u16 len, const u8 *buf) 223 { 224 struct musb *musb = hw_ep->musb; 225 void __iomem *ep_conf = hw_ep->conf; 226 void __iomem *fifo = hw_ep->fifo; 227 u8 epnum = hw_ep->epnum; 228 229 prefetch(buf); 230 231 dev_dbg(musb->controller, "%cX ep%d fifo %p count %d buf %p\n", 232 'T', epnum, fifo, len, buf); 233 234 if (epnum) 235 musb_writel(ep_conf, TUSB_EP_TX_OFFSET, 236 TUSB_EP_CONFIG_XFR_SIZE(len)); 237 else 238 musb_writel(ep_conf, 0, TUSB_EP0_CONFIG_DIR_TX | 239 TUSB_EP0_CONFIG_XFR_SIZE(len)); 240 241 if (likely((0x01 & (unsigned long) buf) == 0)) { 242 243 /* Best case is 32bit-aligned destination address */ 244 if ((0x02 & (unsigned long) buf) == 0) { 245 if (len >= 4) { 246 iowrite32_rep(fifo, buf, len >> 2); 247 buf += (len & ~0x03); 248 len &= 0x03; 249 } 250 } else { 251 if (len >= 2) { 252 u32 val; 253 int i; 254 255 /* Cannot use writesw, fifo is 32-bit */ 256 for (i = 0; i < (len >> 2); i++) { 257 val = (u32)(*(u16 *)buf); 258 buf += 2; 259 val |= (*(u16 *)buf) << 16; 260 buf += 2; 261 musb_writel(fifo, 0, val); 262 } 263 len &= 0x03; 264 } 265 } 266 } 267 268 if (len > 0) 269 tusb_fifo_write_unaligned(fifo, buf, len); 270 } 271 272 static void tusb_read_fifo(struct musb_hw_ep *hw_ep, u16 len, u8 *buf) 273 { 274 struct musb *musb = hw_ep->musb; 275 void __iomem *ep_conf = hw_ep->conf; 276 void __iomem *fifo = hw_ep->fifo; 277 u8 epnum = hw_ep->epnum; 278 279 dev_dbg(musb->controller, "%cX ep%d fifo %p count %d buf %p\n", 280 'R', epnum, fifo, len, buf); 281 282 if (epnum) 283 musb_writel(ep_conf, TUSB_EP_RX_OFFSET, 284 TUSB_EP_CONFIG_XFR_SIZE(len)); 285 else 286 musb_writel(ep_conf, 0, TUSB_EP0_CONFIG_XFR_SIZE(len)); 287 288 if (likely((0x01 & (unsigned long) buf) == 0)) { 289 290 /* Best case is 32bit-aligned destination address */ 291 if ((0x02 & (unsigned long) buf) == 0) { 292 if (len >= 4) { 293 ioread32_rep(fifo, buf, len >> 2); 294 buf += (len & ~0x03); 295 len &= 0x03; 296 } 297 } else { 298 if (len >= 2) { 299 u32 val; 300 int i; 301 302 /* Cannot use readsw, fifo is 32-bit */ 303 for (i = 0; i < (len >> 2); i++) { 304 val = musb_readl(fifo, 0); 305 *(u16 *)buf = (u16)(val & 0xffff); 306 buf += 2; 307 *(u16 *)buf = (u16)(val >> 16); 308 buf += 2; 309 } 310 len &= 0x03; 311 } 312 } 313 } 314 315 if (len > 0) 316 tusb_fifo_read_unaligned(fifo, buf, len); 317 } 318 319 static struct musb *the_musb; 320 321 /* This is used by gadget drivers, and OTG transceiver logic, allowing 322 * at most mA current to be drawn from VBUS during a Default-B session 323 * (that is, while VBUS exceeds 4.4V). In Default-A (including pure host 324 * mode), or low power Default-B sessions, something else supplies power. 325 * Caller must take care of locking. 326 */ 327 static int tusb_draw_power(struct usb_phy *x, unsigned mA) 328 { 329 struct musb *musb = the_musb; 330 void __iomem *tbase = musb->ctrl_base; 331 u32 reg; 332 333 /* tps65030 seems to consume max 100mA, with maybe 60mA available 334 * (measured on one board) for things other than tps and tusb. 335 * 336 * Boards sharing the CPU clock with CLKIN will need to prevent 337 * certain idle sleep states while the USB link is active. 338 * 339 * REVISIT we could use VBUS to supply only _one_ of { 1.5V, 3.3V }. 340 * The actual current usage would be very board-specific. For now, 341 * it's simpler to just use an aggregate (also board-specific). 342 */ 343 if (x->otg->default_a || mA < (musb->min_power << 1)) 344 mA = 0; 345 346 reg = musb_readl(tbase, TUSB_PRCM_MNGMT); 347 if (mA) { 348 musb->is_bus_powered = 1; 349 reg |= TUSB_PRCM_MNGMT_15_SW_EN | TUSB_PRCM_MNGMT_33_SW_EN; 350 } else { 351 musb->is_bus_powered = 0; 352 reg &= ~(TUSB_PRCM_MNGMT_15_SW_EN | TUSB_PRCM_MNGMT_33_SW_EN); 353 } 354 musb_writel(tbase, TUSB_PRCM_MNGMT, reg); 355 356 dev_dbg(musb->controller, "draw max %d mA VBUS\n", mA); 357 return 0; 358 } 359 360 /* workaround for issue 13: change clock during chip idle 361 * (to be fixed in rev3 silicon) ... symptoms include disconnect 362 * or looping suspend/resume cycles 363 */ 364 static void tusb_set_clock_source(struct musb *musb, unsigned mode) 365 { 366 void __iomem *tbase = musb->ctrl_base; 367 u32 reg; 368 369 reg = musb_readl(tbase, TUSB_PRCM_CONF); 370 reg &= ~TUSB_PRCM_CONF_SYS_CLKSEL(0x3); 371 372 /* 0 = refclk (clkin, XI) 373 * 1 = PHY 60 MHz (internal PLL) 374 * 2 = not supported 375 * 3 = what? 376 */ 377 if (mode > 0) 378 reg |= TUSB_PRCM_CONF_SYS_CLKSEL(mode & 0x3); 379 380 musb_writel(tbase, TUSB_PRCM_CONF, reg); 381 382 /* FIXME tusb6010_platform_retime(mode == 0); */ 383 } 384 385 /* 386 * Idle TUSB6010 until next wake-up event; NOR access always wakes. 387 * Other code ensures that we idle unless we're connected _and_ the 388 * USB link is not suspended ... and tells us the relevant wakeup 389 * events. SW_EN for voltage is handled separately. 390 */ 391 static void tusb_allow_idle(struct musb *musb, u32 wakeup_enables) 392 { 393 void __iomem *tbase = musb->ctrl_base; 394 u32 reg; 395 396 if ((wakeup_enables & TUSB_PRCM_WBUS) 397 && (musb->tusb_revision == TUSB_REV_30)) 398 tusb_wbus_quirk(musb, 1); 399 400 tusb_set_clock_source(musb, 0); 401 402 wakeup_enables |= TUSB_PRCM_WNORCS; 403 musb_writel(tbase, TUSB_PRCM_WAKEUP_MASK, ~wakeup_enables); 404 405 /* REVISIT writeup of WID implies that if WID set and ID is grounded, 406 * TUSB_PHY_OTG_CTRL.TUSB_PHY_OTG_CTRL_OTG_ID_PULLUP must be cleared. 407 * Presumably that's mostly to save power, hence WID is immaterial ... 408 */ 409 410 reg = musb_readl(tbase, TUSB_PRCM_MNGMT); 411 /* issue 4: when driving vbus, use hipower (vbus_det) comparator */ 412 if (is_host_active(musb)) { 413 reg |= TUSB_PRCM_MNGMT_OTG_VBUS_DET_EN; 414 reg &= ~TUSB_PRCM_MNGMT_OTG_SESS_END_EN; 415 } else { 416 reg |= TUSB_PRCM_MNGMT_OTG_SESS_END_EN; 417 reg &= ~TUSB_PRCM_MNGMT_OTG_VBUS_DET_EN; 418 } 419 reg |= TUSB_PRCM_MNGMT_PM_IDLE | TUSB_PRCM_MNGMT_DEV_IDLE; 420 musb_writel(tbase, TUSB_PRCM_MNGMT, reg); 421 422 dev_dbg(musb->controller, "idle, wake on %02x\n", wakeup_enables); 423 } 424 425 /* 426 * Updates cable VBUS status. Caller must take care of locking. 427 */ 428 static int tusb_musb_vbus_status(struct musb *musb) 429 { 430 void __iomem *tbase = musb->ctrl_base; 431 u32 otg_stat, prcm_mngmt; 432 int ret = 0; 433 434 otg_stat = musb_readl(tbase, TUSB_DEV_OTG_STAT); 435 prcm_mngmt = musb_readl(tbase, TUSB_PRCM_MNGMT); 436 437 /* Temporarily enable VBUS detection if it was disabled for 438 * suspend mode. Unless it's enabled otg_stat and devctl will 439 * not show correct VBUS state. 440 */ 441 if (!(prcm_mngmt & TUSB_PRCM_MNGMT_OTG_VBUS_DET_EN)) { 442 u32 tmp = prcm_mngmt; 443 tmp |= TUSB_PRCM_MNGMT_OTG_VBUS_DET_EN; 444 musb_writel(tbase, TUSB_PRCM_MNGMT, tmp); 445 otg_stat = musb_readl(tbase, TUSB_DEV_OTG_STAT); 446 musb_writel(tbase, TUSB_PRCM_MNGMT, prcm_mngmt); 447 } 448 449 if (otg_stat & TUSB_DEV_OTG_STAT_VBUS_VALID) 450 ret = 1; 451 452 return ret; 453 } 454 455 static struct timer_list musb_idle_timer; 456 457 static void musb_do_idle(unsigned long _musb) 458 { 459 struct musb *musb = (void *)_musb; 460 unsigned long flags; 461 462 spin_lock_irqsave(&musb->lock, flags); 463 464 switch (musb->xceiv->otg->state) { 465 case OTG_STATE_A_WAIT_BCON: 466 if ((musb->a_wait_bcon != 0) 467 && (musb->idle_timeout == 0 468 || time_after(jiffies, musb->idle_timeout))) { 469 dev_dbg(musb->controller, "Nothing connected %s, turning off VBUS\n", 470 usb_otg_state_string(musb->xceiv->otg->state)); 471 } 472 /* FALLTHROUGH */ 473 case OTG_STATE_A_IDLE: 474 tusb_musb_set_vbus(musb, 0); 475 default: 476 break; 477 } 478 479 if (!musb->is_active) { 480 u32 wakeups; 481 482 /* wait until hub_wq handles port change status */ 483 if (is_host_active(musb) && (musb->port1_status >> 16)) 484 goto done; 485 486 if (!musb->gadget_driver) { 487 wakeups = 0; 488 } else { 489 wakeups = TUSB_PRCM_WHOSTDISCON 490 | TUSB_PRCM_WBUS 491 | TUSB_PRCM_WVBUS; 492 wakeups |= TUSB_PRCM_WID; 493 } 494 tusb_allow_idle(musb, wakeups); 495 } 496 done: 497 spin_unlock_irqrestore(&musb->lock, flags); 498 } 499 500 /* 501 * Maybe put TUSB6010 into idle mode mode depending on USB link status, 502 * like "disconnected" or "suspended". We'll be woken out of it by 503 * connect, resume, or disconnect. 504 * 505 * Needs to be called as the last function everywhere where there is 506 * register access to TUSB6010 because of NOR flash wake-up. 507 * Caller should own controller spinlock. 508 * 509 * Delay because peripheral enables D+ pullup 3msec after SE0, and 510 * we don't want to treat that full speed J as a wakeup event. 511 * ... peripherals must draw only suspend current after 10 msec. 512 */ 513 static void tusb_musb_try_idle(struct musb *musb, unsigned long timeout) 514 { 515 unsigned long default_timeout = jiffies + msecs_to_jiffies(3); 516 static unsigned long last_timer; 517 518 if (timeout == 0) 519 timeout = default_timeout; 520 521 /* Never idle if active, or when VBUS timeout is not set as host */ 522 if (musb->is_active || ((musb->a_wait_bcon == 0) 523 && (musb->xceiv->otg->state == OTG_STATE_A_WAIT_BCON))) { 524 dev_dbg(musb->controller, "%s active, deleting timer\n", 525 usb_otg_state_string(musb->xceiv->otg->state)); 526 del_timer(&musb_idle_timer); 527 last_timer = jiffies; 528 return; 529 } 530 531 if (time_after(last_timer, timeout)) { 532 if (!timer_pending(&musb_idle_timer)) 533 last_timer = timeout; 534 else { 535 dev_dbg(musb->controller, "Longer idle timer already pending, ignoring\n"); 536 return; 537 } 538 } 539 last_timer = timeout; 540 541 dev_dbg(musb->controller, "%s inactive, for idle timer for %lu ms\n", 542 usb_otg_state_string(musb->xceiv->otg->state), 543 (unsigned long)jiffies_to_msecs(timeout - jiffies)); 544 mod_timer(&musb_idle_timer, timeout); 545 } 546 547 /* ticks of 60 MHz clock */ 548 #define DEVCLOCK 60000000 549 #define OTG_TIMER_MS(msecs) ((msecs) \ 550 ? (TUSB_DEV_OTG_TIMER_VAL((DEVCLOCK/1000)*(msecs)) \ 551 | TUSB_DEV_OTG_TIMER_ENABLE) \ 552 : 0) 553 554 static void tusb_musb_set_vbus(struct musb *musb, int is_on) 555 { 556 void __iomem *tbase = musb->ctrl_base; 557 u32 conf, prcm, timer; 558 u8 devctl; 559 struct usb_otg *otg = musb->xceiv->otg; 560 561 /* HDRC controls CPEN, but beware current surges during device 562 * connect. They can trigger transient overcurrent conditions 563 * that must be ignored. 564 */ 565 566 prcm = musb_readl(tbase, TUSB_PRCM_MNGMT); 567 conf = musb_readl(tbase, TUSB_DEV_CONF); 568 devctl = musb_readb(musb->mregs, MUSB_DEVCTL); 569 570 if (is_on) { 571 timer = OTG_TIMER_MS(OTG_TIME_A_WAIT_VRISE); 572 otg->default_a = 1; 573 musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE; 574 devctl |= MUSB_DEVCTL_SESSION; 575 576 conf |= TUSB_DEV_CONF_USB_HOST_MODE; 577 MUSB_HST_MODE(musb); 578 } else { 579 u32 otg_stat; 580 581 timer = 0; 582 583 /* If ID pin is grounded, we want to be a_idle */ 584 otg_stat = musb_readl(tbase, TUSB_DEV_OTG_STAT); 585 if (!(otg_stat & TUSB_DEV_OTG_STAT_ID_STATUS)) { 586 switch (musb->xceiv->otg->state) { 587 case OTG_STATE_A_WAIT_VRISE: 588 case OTG_STATE_A_WAIT_BCON: 589 musb->xceiv->otg->state = OTG_STATE_A_WAIT_VFALL; 590 break; 591 case OTG_STATE_A_WAIT_VFALL: 592 musb->xceiv->otg->state = OTG_STATE_A_IDLE; 593 break; 594 default: 595 musb->xceiv->otg->state = OTG_STATE_A_IDLE; 596 } 597 musb->is_active = 0; 598 otg->default_a = 1; 599 MUSB_HST_MODE(musb); 600 } else { 601 musb->is_active = 0; 602 otg->default_a = 0; 603 musb->xceiv->otg->state = OTG_STATE_B_IDLE; 604 MUSB_DEV_MODE(musb); 605 } 606 607 devctl &= ~MUSB_DEVCTL_SESSION; 608 conf &= ~TUSB_DEV_CONF_USB_HOST_MODE; 609 } 610 prcm &= ~(TUSB_PRCM_MNGMT_15_SW_EN | TUSB_PRCM_MNGMT_33_SW_EN); 611 612 musb_writel(tbase, TUSB_PRCM_MNGMT, prcm); 613 musb_writel(tbase, TUSB_DEV_OTG_TIMER, timer); 614 musb_writel(tbase, TUSB_DEV_CONF, conf); 615 musb_writeb(musb->mregs, MUSB_DEVCTL, devctl); 616 617 dev_dbg(musb->controller, "VBUS %s, devctl %02x otg %3x conf %08x prcm %08x\n", 618 usb_otg_state_string(musb->xceiv->otg->state), 619 musb_readb(musb->mregs, MUSB_DEVCTL), 620 musb_readl(tbase, TUSB_DEV_OTG_STAT), 621 conf, prcm); 622 } 623 624 /* 625 * Sets the mode to OTG, peripheral or host by changing the ID detection. 626 * Caller must take care of locking. 627 * 628 * Note that if a mini-A cable is plugged in the ID line will stay down as 629 * the weak ID pull-up is not able to pull the ID up. 630 */ 631 static int tusb_musb_set_mode(struct musb *musb, u8 musb_mode) 632 { 633 void __iomem *tbase = musb->ctrl_base; 634 u32 otg_stat, phy_otg_ctrl, phy_otg_ena, dev_conf; 635 636 otg_stat = musb_readl(tbase, TUSB_DEV_OTG_STAT); 637 phy_otg_ctrl = musb_readl(tbase, TUSB_PHY_OTG_CTRL); 638 phy_otg_ena = musb_readl(tbase, TUSB_PHY_OTG_CTRL_ENABLE); 639 dev_conf = musb_readl(tbase, TUSB_DEV_CONF); 640 641 switch (musb_mode) { 642 643 case MUSB_HOST: /* Disable PHY ID detect, ground ID */ 644 phy_otg_ctrl &= ~TUSB_PHY_OTG_CTRL_OTG_ID_PULLUP; 645 phy_otg_ena |= TUSB_PHY_OTG_CTRL_OTG_ID_PULLUP; 646 dev_conf |= TUSB_DEV_CONF_ID_SEL; 647 dev_conf &= ~TUSB_DEV_CONF_SOFT_ID; 648 break; 649 case MUSB_PERIPHERAL: /* Disable PHY ID detect, keep ID pull-up on */ 650 phy_otg_ctrl |= TUSB_PHY_OTG_CTRL_OTG_ID_PULLUP; 651 phy_otg_ena |= TUSB_PHY_OTG_CTRL_OTG_ID_PULLUP; 652 dev_conf |= (TUSB_DEV_CONF_ID_SEL | TUSB_DEV_CONF_SOFT_ID); 653 break; 654 case MUSB_OTG: /* Use PHY ID detection */ 655 phy_otg_ctrl |= TUSB_PHY_OTG_CTRL_OTG_ID_PULLUP; 656 phy_otg_ena |= TUSB_PHY_OTG_CTRL_OTG_ID_PULLUP; 657 dev_conf &= ~(TUSB_DEV_CONF_ID_SEL | TUSB_DEV_CONF_SOFT_ID); 658 break; 659 660 default: 661 dev_dbg(musb->controller, "Trying to set mode %i\n", musb_mode); 662 return -EINVAL; 663 } 664 665 musb_writel(tbase, TUSB_PHY_OTG_CTRL, 666 TUSB_PHY_OTG_CTRL_WRPROTECT | phy_otg_ctrl); 667 musb_writel(tbase, TUSB_PHY_OTG_CTRL_ENABLE, 668 TUSB_PHY_OTG_CTRL_WRPROTECT | phy_otg_ena); 669 musb_writel(tbase, TUSB_DEV_CONF, dev_conf); 670 671 otg_stat = musb_readl(tbase, TUSB_DEV_OTG_STAT); 672 if ((musb_mode == MUSB_PERIPHERAL) && 673 !(otg_stat & TUSB_DEV_OTG_STAT_ID_STATUS)) 674 INFO("Cannot be peripheral with mini-A cable " 675 "otg_stat: %08x\n", otg_stat); 676 677 return 0; 678 } 679 680 static inline unsigned long 681 tusb_otg_ints(struct musb *musb, u32 int_src, void __iomem *tbase) 682 { 683 u32 otg_stat = musb_readl(tbase, TUSB_DEV_OTG_STAT); 684 unsigned long idle_timeout = 0; 685 struct usb_otg *otg = musb->xceiv->otg; 686 687 /* ID pin */ 688 if ((int_src & TUSB_INT_SRC_ID_STATUS_CHNG)) { 689 int default_a; 690 691 default_a = !(otg_stat & TUSB_DEV_OTG_STAT_ID_STATUS); 692 dev_dbg(musb->controller, "Default-%c\n", default_a ? 'A' : 'B'); 693 otg->default_a = default_a; 694 tusb_musb_set_vbus(musb, default_a); 695 696 /* Don't allow idling immediately */ 697 if (default_a) 698 idle_timeout = jiffies + (HZ * 3); 699 } 700 701 /* VBUS state change */ 702 if (int_src & TUSB_INT_SRC_VBUS_SENSE_CHNG) { 703 704 /* B-dev state machine: no vbus ~= disconnect */ 705 if (!otg->default_a) { 706 /* ? musb_root_disconnect(musb); */ 707 musb->port1_status &= 708 ~(USB_PORT_STAT_CONNECTION 709 | USB_PORT_STAT_ENABLE 710 | USB_PORT_STAT_LOW_SPEED 711 | USB_PORT_STAT_HIGH_SPEED 712 | USB_PORT_STAT_TEST 713 ); 714 715 if (otg_stat & TUSB_DEV_OTG_STAT_SESS_END) { 716 dev_dbg(musb->controller, "Forcing disconnect (no interrupt)\n"); 717 if (musb->xceiv->otg->state != OTG_STATE_B_IDLE) { 718 /* INTR_DISCONNECT can hide... */ 719 musb->xceiv->otg->state = OTG_STATE_B_IDLE; 720 musb->int_usb |= MUSB_INTR_DISCONNECT; 721 } 722 musb->is_active = 0; 723 } 724 dev_dbg(musb->controller, "vbus change, %s, otg %03x\n", 725 usb_otg_state_string(musb->xceiv->otg->state), otg_stat); 726 idle_timeout = jiffies + (1 * HZ); 727 schedule_work(&musb->irq_work); 728 729 } else /* A-dev state machine */ { 730 dev_dbg(musb->controller, "vbus change, %s, otg %03x\n", 731 usb_otg_state_string(musb->xceiv->otg->state), otg_stat); 732 733 switch (musb->xceiv->otg->state) { 734 case OTG_STATE_A_IDLE: 735 dev_dbg(musb->controller, "Got SRP, turning on VBUS\n"); 736 musb_platform_set_vbus(musb, 1); 737 738 /* CONNECT can wake if a_wait_bcon is set */ 739 if (musb->a_wait_bcon != 0) 740 musb->is_active = 0; 741 else 742 musb->is_active = 1; 743 744 /* 745 * OPT FS A TD.4.6 needs few seconds for 746 * A_WAIT_VRISE 747 */ 748 idle_timeout = jiffies + (2 * HZ); 749 750 break; 751 case OTG_STATE_A_WAIT_VRISE: 752 /* ignore; A-session-valid < VBUS_VALID/2, 753 * we monitor this with the timer 754 */ 755 break; 756 case OTG_STATE_A_WAIT_VFALL: 757 /* REVISIT this irq triggers during short 758 * spikes caused by enumeration ... 759 */ 760 if (musb->vbuserr_retry) { 761 musb->vbuserr_retry--; 762 tusb_musb_set_vbus(musb, 1); 763 } else { 764 musb->vbuserr_retry 765 = VBUSERR_RETRY_COUNT; 766 tusb_musb_set_vbus(musb, 0); 767 } 768 break; 769 default: 770 break; 771 } 772 } 773 } 774 775 /* OTG timer expiration */ 776 if (int_src & TUSB_INT_SRC_OTG_TIMEOUT) { 777 u8 devctl; 778 779 dev_dbg(musb->controller, "%s timer, %03x\n", 780 usb_otg_state_string(musb->xceiv->otg->state), otg_stat); 781 782 switch (musb->xceiv->otg->state) { 783 case OTG_STATE_A_WAIT_VRISE: 784 /* VBUS has probably been valid for a while now, 785 * but may well have bounced out of range a bit 786 */ 787 devctl = musb_readb(musb->mregs, MUSB_DEVCTL); 788 if (otg_stat & TUSB_DEV_OTG_STAT_VBUS_VALID) { 789 if ((devctl & MUSB_DEVCTL_VBUS) 790 != MUSB_DEVCTL_VBUS) { 791 dev_dbg(musb->controller, "devctl %02x\n", devctl); 792 break; 793 } 794 musb->xceiv->otg->state = OTG_STATE_A_WAIT_BCON; 795 musb->is_active = 0; 796 idle_timeout = jiffies 797 + msecs_to_jiffies(musb->a_wait_bcon); 798 } else { 799 /* REVISIT report overcurrent to hub? */ 800 ERR("vbus too slow, devctl %02x\n", devctl); 801 tusb_musb_set_vbus(musb, 0); 802 } 803 break; 804 case OTG_STATE_A_WAIT_BCON: 805 if (musb->a_wait_bcon != 0) 806 idle_timeout = jiffies 807 + msecs_to_jiffies(musb->a_wait_bcon); 808 break; 809 case OTG_STATE_A_SUSPEND: 810 break; 811 case OTG_STATE_B_WAIT_ACON: 812 break; 813 default: 814 break; 815 } 816 } 817 schedule_work(&musb->irq_work); 818 819 return idle_timeout; 820 } 821 822 static irqreturn_t tusb_musb_interrupt(int irq, void *__hci) 823 { 824 struct musb *musb = __hci; 825 void __iomem *tbase = musb->ctrl_base; 826 unsigned long flags, idle_timeout = 0; 827 u32 int_mask, int_src; 828 829 spin_lock_irqsave(&musb->lock, flags); 830 831 /* Mask all interrupts to allow using both edge and level GPIO irq */ 832 int_mask = musb_readl(tbase, TUSB_INT_MASK); 833 musb_writel(tbase, TUSB_INT_MASK, ~TUSB_INT_MASK_RESERVED_BITS); 834 835 int_src = musb_readl(tbase, TUSB_INT_SRC) & ~TUSB_INT_SRC_RESERVED_BITS; 836 dev_dbg(musb->controller, "TUSB IRQ %08x\n", int_src); 837 838 musb->int_usb = (u8) int_src; 839 840 /* Acknowledge wake-up source interrupts */ 841 if (int_src & TUSB_INT_SRC_DEV_WAKEUP) { 842 u32 reg; 843 u32 i; 844 845 if (musb->tusb_revision == TUSB_REV_30) 846 tusb_wbus_quirk(musb, 0); 847 848 /* there are issues re-locking the PLL on wakeup ... */ 849 850 /* work around issue 8 */ 851 for (i = 0xf7f7f7; i > 0xf7f7f7 - 1000; i--) { 852 musb_writel(tbase, TUSB_SCRATCH_PAD, 0); 853 musb_writel(tbase, TUSB_SCRATCH_PAD, i); 854 reg = musb_readl(tbase, TUSB_SCRATCH_PAD); 855 if (reg == i) 856 break; 857 dev_dbg(musb->controller, "TUSB NOR not ready\n"); 858 } 859 860 /* work around issue 13 (2nd half) */ 861 tusb_set_clock_source(musb, 1); 862 863 reg = musb_readl(tbase, TUSB_PRCM_WAKEUP_SOURCE); 864 musb_writel(tbase, TUSB_PRCM_WAKEUP_CLEAR, reg); 865 if (reg & ~TUSB_PRCM_WNORCS) { 866 musb->is_active = 1; 867 schedule_work(&musb->irq_work); 868 } 869 dev_dbg(musb->controller, "wake %sactive %02x\n", 870 musb->is_active ? "" : "in", reg); 871 872 /* REVISIT host side TUSB_PRCM_WHOSTDISCON, TUSB_PRCM_WBUS */ 873 } 874 875 if (int_src & TUSB_INT_SRC_USB_IP_CONN) 876 del_timer(&musb_idle_timer); 877 878 /* OTG state change reports (annoyingly) not issued by Mentor core */ 879 if (int_src & (TUSB_INT_SRC_VBUS_SENSE_CHNG 880 | TUSB_INT_SRC_OTG_TIMEOUT 881 | TUSB_INT_SRC_ID_STATUS_CHNG)) 882 idle_timeout = tusb_otg_ints(musb, int_src, tbase); 883 884 /* TX dma callback must be handled here, RX dma callback is 885 * handled in tusb_omap_dma_cb. 886 */ 887 if ((int_src & TUSB_INT_SRC_TXRX_DMA_DONE)) { 888 u32 dma_src = musb_readl(tbase, TUSB_DMA_INT_SRC); 889 u32 real_dma_src = musb_readl(tbase, TUSB_DMA_INT_MASK); 890 891 dev_dbg(musb->controller, "DMA IRQ %08x\n", dma_src); 892 real_dma_src = ~real_dma_src & dma_src; 893 if (tusb_dma_omap() && real_dma_src) { 894 int tx_source = (real_dma_src & 0xffff); 895 int i; 896 897 for (i = 1; i <= 15; i++) { 898 if (tx_source & (1 << i)) { 899 dev_dbg(musb->controller, "completing ep%i %s\n", i, "tx"); 900 musb_dma_completion(musb, i, 1); 901 } 902 } 903 } 904 musb_writel(tbase, TUSB_DMA_INT_CLEAR, dma_src); 905 } 906 907 /* EP interrupts. In OCP mode tusb6010 mirrors the MUSB interrupts */ 908 if (int_src & (TUSB_INT_SRC_USB_IP_TX | TUSB_INT_SRC_USB_IP_RX)) { 909 u32 musb_src = musb_readl(tbase, TUSB_USBIP_INT_SRC); 910 911 musb_writel(tbase, TUSB_USBIP_INT_CLEAR, musb_src); 912 musb->int_rx = (((musb_src >> 16) & 0xffff) << 1); 913 musb->int_tx = (musb_src & 0xffff); 914 } else { 915 musb->int_rx = 0; 916 musb->int_tx = 0; 917 } 918 919 if (int_src & (TUSB_INT_SRC_USB_IP_TX | TUSB_INT_SRC_USB_IP_RX | 0xff)) 920 musb_interrupt(musb); 921 922 /* Acknowledge TUSB interrupts. Clear only non-reserved bits */ 923 musb_writel(tbase, TUSB_INT_SRC_CLEAR, 924 int_src & ~TUSB_INT_MASK_RESERVED_BITS); 925 926 tusb_musb_try_idle(musb, idle_timeout); 927 928 musb_writel(tbase, TUSB_INT_MASK, int_mask); 929 spin_unlock_irqrestore(&musb->lock, flags); 930 931 return IRQ_HANDLED; 932 } 933 934 static int dma_off; 935 936 /* 937 * Enables TUSB6010. Caller must take care of locking. 938 * REVISIT: 939 * - Check what is unnecessary in MGC_HdrcStart() 940 */ 941 static void tusb_musb_enable(struct musb *musb) 942 { 943 void __iomem *tbase = musb->ctrl_base; 944 945 /* Setup TUSB6010 main interrupt mask. Enable all interrupts except SOF. 946 * REVISIT: Enable and deal with TUSB_INT_SRC_USB_IP_SOF */ 947 musb_writel(tbase, TUSB_INT_MASK, TUSB_INT_SRC_USB_IP_SOF); 948 949 /* Setup TUSB interrupt, disable DMA and GPIO interrupts */ 950 musb_writel(tbase, TUSB_USBIP_INT_MASK, 0); 951 musb_writel(tbase, TUSB_DMA_INT_MASK, 0x7fffffff); 952 musb_writel(tbase, TUSB_GPIO_INT_MASK, 0x1ff); 953 954 /* Clear all subsystem interrups */ 955 musb_writel(tbase, TUSB_USBIP_INT_CLEAR, 0x7fffffff); 956 musb_writel(tbase, TUSB_DMA_INT_CLEAR, 0x7fffffff); 957 musb_writel(tbase, TUSB_GPIO_INT_CLEAR, 0x1ff); 958 959 /* Acknowledge pending interrupt(s) */ 960 musb_writel(tbase, TUSB_INT_SRC_CLEAR, ~TUSB_INT_MASK_RESERVED_BITS); 961 962 /* Only 0 clock cycles for minimum interrupt de-assertion time and 963 * interrupt polarity active low seems to work reliably here */ 964 musb_writel(tbase, TUSB_INT_CTRL_CONF, 965 TUSB_INT_CTRL_CONF_INT_RELCYC(0)); 966 967 irq_set_irq_type(musb->nIrq, IRQ_TYPE_LEVEL_LOW); 968 969 /* maybe force into the Default-A OTG state machine */ 970 if (!(musb_readl(tbase, TUSB_DEV_OTG_STAT) 971 & TUSB_DEV_OTG_STAT_ID_STATUS)) 972 musb_writel(tbase, TUSB_INT_SRC_SET, 973 TUSB_INT_SRC_ID_STATUS_CHNG); 974 975 if (is_dma_capable() && dma_off) 976 printk(KERN_WARNING "%s %s: dma not reactivated\n", 977 __FILE__, __func__); 978 else 979 dma_off = 1; 980 } 981 982 /* 983 * Disables TUSB6010. Caller must take care of locking. 984 */ 985 static void tusb_musb_disable(struct musb *musb) 986 { 987 void __iomem *tbase = musb->ctrl_base; 988 989 /* FIXME stop DMA, IRQs, timers, ... */ 990 991 /* disable all IRQs */ 992 musb_writel(tbase, TUSB_INT_MASK, ~TUSB_INT_MASK_RESERVED_BITS); 993 musb_writel(tbase, TUSB_USBIP_INT_MASK, 0x7fffffff); 994 musb_writel(tbase, TUSB_DMA_INT_MASK, 0x7fffffff); 995 musb_writel(tbase, TUSB_GPIO_INT_MASK, 0x1ff); 996 997 del_timer(&musb_idle_timer); 998 999 if (is_dma_capable() && !dma_off) { 1000 printk(KERN_WARNING "%s %s: dma still active\n", 1001 __FILE__, __func__); 1002 dma_off = 1; 1003 } 1004 } 1005 1006 /* 1007 * Sets up TUSB6010 CPU interface specific signals and registers 1008 * Note: Settings optimized for OMAP24xx 1009 */ 1010 static void tusb_setup_cpu_interface(struct musb *musb) 1011 { 1012 void __iomem *tbase = musb->ctrl_base; 1013 1014 /* 1015 * Disable GPIO[5:0] pullups (used as output DMA requests) 1016 * Don't disable GPIO[7:6] as they are needed for wake-up. 1017 */ 1018 musb_writel(tbase, TUSB_PULLUP_1_CTRL, 0x0000003F); 1019 1020 /* Disable all pullups on NOR IF, DMAREQ0 and DMAREQ1 */ 1021 musb_writel(tbase, TUSB_PULLUP_2_CTRL, 0x01FFFFFF); 1022 1023 /* Turn GPIO[5:0] to DMAREQ[5:0] signals */ 1024 musb_writel(tbase, TUSB_GPIO_CONF, TUSB_GPIO_CONF_DMAREQ(0x3f)); 1025 1026 /* Burst size 16x16 bits, all six DMA requests enabled, DMA request 1027 * de-assertion time 2 system clocks p 62 */ 1028 musb_writel(tbase, TUSB_DMA_REQ_CONF, 1029 TUSB_DMA_REQ_CONF_BURST_SIZE(2) | 1030 TUSB_DMA_REQ_CONF_DMA_REQ_EN(0x3f) | 1031 TUSB_DMA_REQ_CONF_DMA_REQ_ASSER(2)); 1032 1033 /* Set 0 wait count for synchronous burst access */ 1034 musb_writel(tbase, TUSB_WAIT_COUNT, 1); 1035 } 1036 1037 static int tusb_musb_start(struct musb *musb) 1038 { 1039 void __iomem *tbase = musb->ctrl_base; 1040 int ret = 0; 1041 unsigned long flags; 1042 u32 reg; 1043 1044 if (musb->board_set_power) 1045 ret = musb->board_set_power(1); 1046 if (ret != 0) { 1047 printk(KERN_ERR "tusb: Cannot enable TUSB6010\n"); 1048 return ret; 1049 } 1050 1051 spin_lock_irqsave(&musb->lock, flags); 1052 1053 if (musb_readl(tbase, TUSB_PROD_TEST_RESET) != 1054 TUSB_PROD_TEST_RESET_VAL) { 1055 printk(KERN_ERR "tusb: Unable to detect TUSB6010\n"); 1056 goto err; 1057 } 1058 1059 musb->tusb_revision = tusb_get_revision(musb); 1060 tusb_print_revision(musb); 1061 if (musb->tusb_revision < 2) { 1062 printk(KERN_ERR "tusb: Unsupported TUSB6010 revision %i\n", 1063 musb->tusb_revision); 1064 goto err; 1065 } 1066 1067 /* The uint bit for "USB non-PDR interrupt enable" has to be 1 when 1068 * NOR FLASH interface is used */ 1069 musb_writel(tbase, TUSB_VLYNQ_CTRL, 8); 1070 1071 /* Select PHY free running 60MHz as a system clock */ 1072 tusb_set_clock_source(musb, 1); 1073 1074 /* VBus valid timer 1us, disable DFT/Debug and VLYNQ clocks for 1075 * power saving, enable VBus detect and session end comparators, 1076 * enable IDpullup, enable VBus charging */ 1077 musb_writel(tbase, TUSB_PRCM_MNGMT, 1078 TUSB_PRCM_MNGMT_VBUS_VALID_TIMER(0xa) | 1079 TUSB_PRCM_MNGMT_VBUS_VALID_FLT_EN | 1080 TUSB_PRCM_MNGMT_OTG_SESS_END_EN | 1081 TUSB_PRCM_MNGMT_OTG_VBUS_DET_EN | 1082 TUSB_PRCM_MNGMT_OTG_ID_PULLUP); 1083 tusb_setup_cpu_interface(musb); 1084 1085 /* simplify: always sense/pullup ID pins, as if in OTG mode */ 1086 reg = musb_readl(tbase, TUSB_PHY_OTG_CTRL_ENABLE); 1087 reg |= TUSB_PHY_OTG_CTRL_WRPROTECT | TUSB_PHY_OTG_CTRL_OTG_ID_PULLUP; 1088 musb_writel(tbase, TUSB_PHY_OTG_CTRL_ENABLE, reg); 1089 1090 reg = musb_readl(tbase, TUSB_PHY_OTG_CTRL); 1091 reg |= TUSB_PHY_OTG_CTRL_WRPROTECT | TUSB_PHY_OTG_CTRL_OTG_ID_PULLUP; 1092 musb_writel(tbase, TUSB_PHY_OTG_CTRL, reg); 1093 1094 spin_unlock_irqrestore(&musb->lock, flags); 1095 1096 return 0; 1097 1098 err: 1099 spin_unlock_irqrestore(&musb->lock, flags); 1100 1101 if (musb->board_set_power) 1102 musb->board_set_power(0); 1103 1104 return -ENODEV; 1105 } 1106 1107 static int tusb_musb_init(struct musb *musb) 1108 { 1109 struct platform_device *pdev; 1110 struct resource *mem; 1111 void __iomem *sync = NULL; 1112 int ret; 1113 1114 musb->xceiv = usb_get_phy(USB_PHY_TYPE_USB2); 1115 if (IS_ERR_OR_NULL(musb->xceiv)) 1116 return -EPROBE_DEFER; 1117 1118 pdev = to_platform_device(musb->controller); 1119 1120 /* dma address for async dma */ 1121 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); 1122 musb->async = mem->start; 1123 1124 /* dma address for sync dma */ 1125 mem = platform_get_resource(pdev, IORESOURCE_MEM, 1); 1126 if (!mem) { 1127 pr_debug("no sync dma resource?\n"); 1128 ret = -ENODEV; 1129 goto done; 1130 } 1131 musb->sync = mem->start; 1132 1133 sync = ioremap(mem->start, resource_size(mem)); 1134 if (!sync) { 1135 pr_debug("ioremap for sync failed\n"); 1136 ret = -ENOMEM; 1137 goto done; 1138 } 1139 musb->sync_va = sync; 1140 1141 /* Offsets from base: VLYNQ at 0x000, MUSB regs at 0x400, 1142 * FIFOs at 0x600, TUSB at 0x800 1143 */ 1144 musb->mregs += TUSB_BASE_OFFSET; 1145 1146 ret = tusb_musb_start(musb); 1147 if (ret) { 1148 printk(KERN_ERR "Could not start tusb6010 (%d)\n", 1149 ret); 1150 goto done; 1151 } 1152 musb->isr = tusb_musb_interrupt; 1153 1154 musb->xceiv->set_power = tusb_draw_power; 1155 the_musb = musb; 1156 1157 setup_timer(&musb_idle_timer, musb_do_idle, (unsigned long) musb); 1158 1159 done: 1160 if (ret < 0) { 1161 if (sync) 1162 iounmap(sync); 1163 1164 usb_put_phy(musb->xceiv); 1165 } 1166 return ret; 1167 } 1168 1169 static int tusb_musb_exit(struct musb *musb) 1170 { 1171 del_timer_sync(&musb_idle_timer); 1172 the_musb = NULL; 1173 1174 if (musb->board_set_power) 1175 musb->board_set_power(0); 1176 1177 iounmap(musb->sync_va); 1178 1179 usb_put_phy(musb->xceiv); 1180 return 0; 1181 } 1182 1183 static const struct musb_platform_ops tusb_ops = { 1184 .quirks = MUSB_IN_TUSB, 1185 .init = tusb_musb_init, 1186 .exit = tusb_musb_exit, 1187 1188 .ep_offset = tusb_ep_offset, 1189 .ep_select = tusb_ep_select, 1190 .fifo_offset = tusb_fifo_offset, 1191 .readb = tusb_readb, 1192 .writeb = tusb_writeb, 1193 .read_fifo = tusb_read_fifo, 1194 .write_fifo = tusb_write_fifo, 1195 .enable = tusb_musb_enable, 1196 .disable = tusb_musb_disable, 1197 1198 .set_mode = tusb_musb_set_mode, 1199 .try_idle = tusb_musb_try_idle, 1200 1201 .vbus_status = tusb_musb_vbus_status, 1202 .set_vbus = tusb_musb_set_vbus, 1203 }; 1204 1205 static const struct platform_device_info tusb_dev_info = { 1206 .name = "musb-hdrc", 1207 .id = PLATFORM_DEVID_AUTO, 1208 .dma_mask = DMA_BIT_MASK(32), 1209 }; 1210 1211 static int tusb_probe(struct platform_device *pdev) 1212 { 1213 struct resource musb_resources[3]; 1214 struct musb_hdrc_platform_data *pdata = dev_get_platdata(&pdev->dev); 1215 struct platform_device *musb; 1216 struct tusb6010_glue *glue; 1217 struct platform_device_info pinfo; 1218 int ret; 1219 1220 glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL); 1221 if (!glue) 1222 return -ENOMEM; 1223 1224 glue->dev = &pdev->dev; 1225 1226 pdata->platform_ops = &tusb_ops; 1227 1228 usb_phy_generic_register(); 1229 platform_set_drvdata(pdev, glue); 1230 1231 memset(musb_resources, 0x00, sizeof(*musb_resources) * 1232 ARRAY_SIZE(musb_resources)); 1233 1234 musb_resources[0].name = pdev->resource[0].name; 1235 musb_resources[0].start = pdev->resource[0].start; 1236 musb_resources[0].end = pdev->resource[0].end; 1237 musb_resources[0].flags = pdev->resource[0].flags; 1238 1239 musb_resources[1].name = pdev->resource[1].name; 1240 musb_resources[1].start = pdev->resource[1].start; 1241 musb_resources[1].end = pdev->resource[1].end; 1242 musb_resources[1].flags = pdev->resource[1].flags; 1243 1244 musb_resources[2].name = pdev->resource[2].name; 1245 musb_resources[2].start = pdev->resource[2].start; 1246 musb_resources[2].end = pdev->resource[2].end; 1247 musb_resources[2].flags = pdev->resource[2].flags; 1248 1249 pinfo = tusb_dev_info; 1250 pinfo.parent = &pdev->dev; 1251 pinfo.res = musb_resources; 1252 pinfo.num_res = ARRAY_SIZE(musb_resources); 1253 pinfo.data = pdata; 1254 pinfo.size_data = sizeof(*pdata); 1255 1256 glue->musb = musb = platform_device_register_full(&pinfo); 1257 if (IS_ERR(musb)) { 1258 ret = PTR_ERR(musb); 1259 dev_err(&pdev->dev, "failed to register musb device: %d\n", ret); 1260 return ret; 1261 } 1262 1263 return 0; 1264 } 1265 1266 static int tusb_remove(struct platform_device *pdev) 1267 { 1268 struct tusb6010_glue *glue = platform_get_drvdata(pdev); 1269 1270 platform_device_unregister(glue->musb); 1271 usb_phy_generic_unregister(glue->phy); 1272 1273 return 0; 1274 } 1275 1276 static struct platform_driver tusb_driver = { 1277 .probe = tusb_probe, 1278 .remove = tusb_remove, 1279 .driver = { 1280 .name = "musb-tusb", 1281 }, 1282 }; 1283 1284 MODULE_DESCRIPTION("TUSB6010 MUSB Glue Layer"); 1285 MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>"); 1286 MODULE_LICENSE("GPL v2"); 1287 module_platform_driver(tusb_driver); 1288