davinci.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636
  1. /*
  2. * Copyright (C) 2005-2006 by Texas Instruments
  3. *
  4. * This file is part of the Inventra Controller Driver for Linux.
  5. *
  6. * The Inventra Controller Driver for Linux is free software; you
  7. * can redistribute it and/or modify it under the terms of the GNU
  8. * General Public License version 2 as published by the Free Software
  9. * Foundation.
  10. *
  11. * The Inventra Controller Driver for Linux is distributed in
  12. * the hope that it will be useful, but WITHOUT ANY WARRANTY;
  13. * without even the implied warranty of MERCHANTABILITY or
  14. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public
  15. * License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with The Inventra Controller Driver for Linux ; if not,
  19. * write to the Free Software Foundation, Inc., 59 Temple Place,
  20. * Suite 330, Boston, MA 02111-1307 USA
  21. *
  22. */
  23. #include <linux/module.h>
  24. #include <linux/kernel.h>
  25. #include <linux/sched.h>
  26. #include <linux/init.h>
  27. #include <linux/list.h>
  28. #include <linux/delay.h>
  29. #include <linux/clk.h>
  30. #include <linux/io.h>
  31. #include <linux/gpio.h>
  32. #include <linux/platform_device.h>
  33. #include <linux/dma-mapping.h>
  34. #include <mach/cputype.h>
  35. #include <mach/hardware.h>
  36. #include <asm/mach-types.h>
  37. #include "musb_core.h"
  38. #ifdef CONFIG_MACH_DAVINCI_EVM
  39. #define GPIO_nVBUS_DRV 160
  40. #endif
  41. #include "davinci.h"
  42. #include "cppi_dma.h"
  43. #define USB_PHY_CTRL IO_ADDRESS(USBPHY_CTL_PADDR)
  44. #define DM355_DEEPSLEEP IO_ADDRESS(DM355_DEEPSLEEP_PADDR)
  45. struct davinci_glue {
  46. struct device *dev;
  47. struct platform_device *musb;
  48. struct clk *clk;
  49. };
  50. /* REVISIT (PM) we should be able to keep the PHY in low power mode most
  51. * of the time (24 MHZ oscillator and PLL off, etc) by setting POWER.D0
  52. * and, when in host mode, autosuspending idle root ports... PHYPLLON
  53. * (overriding SUSPENDM?) then likely needs to stay off.
  54. */
  55. static inline void phy_on(void)
  56. {
  57. u32 phy_ctrl = __raw_readl(USB_PHY_CTRL);
  58. /* power everything up; start the on-chip PHY and its PLL */
  59. phy_ctrl &= ~(USBPHY_OSCPDWN | USBPHY_OTGPDWN | USBPHY_PHYPDWN);
  60. phy_ctrl |= USBPHY_SESNDEN | USBPHY_VBDTCTEN | USBPHY_PHYPLLON;
  61. __raw_writel(phy_ctrl, USB_PHY_CTRL);
  62. /* wait for PLL to lock before proceeding */
  63. while ((__raw_readl(USB_PHY_CTRL) & USBPHY_PHYCLKGD) == 0)
  64. cpu_relax();
  65. }
  66. static inline void phy_off(void)
  67. {
  68. u32 phy_ctrl = __raw_readl(USB_PHY_CTRL);
  69. /* powerdown the on-chip PHY, its PLL, and the OTG block */
  70. phy_ctrl &= ~(USBPHY_SESNDEN | USBPHY_VBDTCTEN | USBPHY_PHYPLLON);
  71. phy_ctrl |= USBPHY_OSCPDWN | USBPHY_OTGPDWN | USBPHY_PHYPDWN;
  72. __raw_writel(phy_ctrl, USB_PHY_CTRL);
  73. }
  74. static int dma_off = 1;
  75. static void davinci_musb_enable(struct musb *musb)
  76. {
  77. u32 tmp, old, val;
  78. /* workaround: setup irqs through both register sets */
  79. tmp = (musb->epmask & DAVINCI_USB_TX_ENDPTS_MASK)
  80. << DAVINCI_USB_TXINT_SHIFT;
  81. musb_writel(musb->ctrl_base, DAVINCI_USB_INT_MASK_SET_REG, tmp);
  82. old = tmp;
  83. tmp = (musb->epmask & (0xfffe & DAVINCI_USB_RX_ENDPTS_MASK))
  84. << DAVINCI_USB_RXINT_SHIFT;
  85. musb_writel(musb->ctrl_base, DAVINCI_USB_INT_MASK_SET_REG, tmp);
  86. tmp |= old;
  87. val = ~MUSB_INTR_SOF;
  88. tmp |= ((val & 0x01ff) << DAVINCI_USB_USBINT_SHIFT);
  89. musb_writel(musb->ctrl_base, DAVINCI_USB_INT_MASK_SET_REG, tmp);
  90. if (is_dma_capable() && !dma_off)
  91. printk(KERN_WARNING "%s %s: dma not reactivated\n",
  92. __FILE__, __func__);
  93. else
  94. dma_off = 0;
  95. /* force a DRVVBUS irq so we can start polling for ID change */
  96. if (is_otg_enabled(musb))
  97. musb_writel(musb->ctrl_base, DAVINCI_USB_INT_SET_REG,
  98. DAVINCI_INTR_DRVVBUS << DAVINCI_USB_USBINT_SHIFT);
  99. }
  100. /*
  101. * Disable the HDRC and flush interrupts
  102. */
  103. static void davinci_musb_disable(struct musb *musb)
  104. {
  105. /* because we don't set CTRLR.UINT, "important" to:
  106. * - not read/write INTRUSB/INTRUSBE
  107. * - (except during initial setup, as workaround)
  108. * - use INTSETR/INTCLRR instead
  109. */
  110. musb_writel(musb->ctrl_base, DAVINCI_USB_INT_MASK_CLR_REG,
  111. DAVINCI_USB_USBINT_MASK
  112. | DAVINCI_USB_TXINT_MASK
  113. | DAVINCI_USB_RXINT_MASK);
  114. musb_writeb(musb->mregs, MUSB_DEVCTL, 0);
  115. musb_writel(musb->ctrl_base, DAVINCI_USB_EOI_REG, 0);
  116. if (is_dma_capable() && !dma_off)
  117. WARNING("dma still active\n");
  118. }
  119. #define portstate(stmt) stmt
  120. /*
  121. * VBUS SWITCHING IS BOARD-SPECIFIC ... at least for the DM6446 EVM,
  122. * which doesn't wire DRVVBUS to the FET that switches it. Unclear
  123. * if that's a problem with the DM6446 chip or just with that board.
  124. *
  125. * In either case, the DM355 EVM automates DRVVBUS the normal way,
  126. * when J10 is out, and TI documents it as handling OTG.
  127. */
  128. #ifdef CONFIG_MACH_DAVINCI_EVM
  129. static int vbus_state = -1;
  130. /* I2C operations are always synchronous, and require a task context.
  131. * With unloaded systems, using the shared workqueue seems to suffice
  132. * to satisfy the 100msec A_WAIT_VRISE timeout...
  133. */
  134. static void evm_deferred_drvvbus(struct work_struct *ignored)
  135. {
  136. gpio_set_value_cansleep(GPIO_nVBUS_DRV, vbus_state);
  137. vbus_state = !vbus_state;
  138. }
  139. #endif /* EVM */
  140. static void davinci_musb_source_power(struct musb *musb, int is_on, int immediate)
  141. {
  142. #ifdef CONFIG_MACH_DAVINCI_EVM
  143. if (is_on)
  144. is_on = 1;
  145. if (vbus_state == is_on)
  146. return;
  147. vbus_state = !is_on; /* 0/1 vs "-1 == unknown/init" */
  148. if (machine_is_davinci_evm()) {
  149. static DECLARE_WORK(evm_vbus_work, evm_deferred_drvvbus);
  150. if (immediate)
  151. gpio_set_value_cansleep(GPIO_nVBUS_DRV, vbus_state);
  152. else
  153. schedule_work(&evm_vbus_work);
  154. }
  155. if (immediate)
  156. vbus_state = is_on;
  157. #endif
  158. }
  159. static void davinci_musb_set_vbus(struct musb *musb, int is_on)
  160. {
  161. WARN_ON(is_on && is_peripheral_active(musb));
  162. davinci_musb_source_power(musb, is_on, 0);
  163. }
  164. #define POLL_SECONDS 2
  165. static struct timer_list otg_workaround;
  166. static void otg_timer(unsigned long _musb)
  167. {
  168. struct musb *musb = (void *)_musb;
  169. void __iomem *mregs = musb->mregs;
  170. u8 devctl;
  171. unsigned long flags;
  172. /* We poll because DaVinci's won't expose several OTG-critical
  173. * status change events (from the transceiver) otherwise.
  174. */
  175. devctl = musb_readb(mregs, MUSB_DEVCTL);
  176. dev_dbg(musb->controller, "poll devctl %02x (%s)\n", devctl,
  177. otg_state_string(musb->xceiv->state));
  178. spin_lock_irqsave(&musb->lock, flags);
  179. switch (musb->xceiv->state) {
  180. case OTG_STATE_A_WAIT_VFALL:
  181. /* Wait till VBUS falls below SessionEnd (~0.2V); the 1.3 RTL
  182. * seems to mis-handle session "start" otherwise (or in our
  183. * case "recover"), in routine "VBUS was valid by the time
  184. * VBUSERR got reported during enumeration" cases.
  185. */
  186. if (devctl & MUSB_DEVCTL_VBUS) {
  187. mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
  188. break;
  189. }
  190. musb->xceiv->state = OTG_STATE_A_WAIT_VRISE;
  191. musb_writel(musb->ctrl_base, DAVINCI_USB_INT_SET_REG,
  192. MUSB_INTR_VBUSERROR << DAVINCI_USB_USBINT_SHIFT);
  193. break;
  194. case OTG_STATE_B_IDLE:
  195. if (!is_peripheral_enabled(musb))
  196. break;
  197. /* There's no ID-changed IRQ, so we have no good way to tell
  198. * when to switch to the A-Default state machine (by setting
  199. * the DEVCTL.SESSION flag).
  200. *
  201. * Workaround: whenever we're in B_IDLE, try setting the
  202. * session flag every few seconds. If it works, ID was
  203. * grounded and we're now in the A-Default state machine.
  204. *
  205. * NOTE setting the session flag is _supposed_ to trigger
  206. * SRP, but clearly it doesn't.
  207. */
  208. musb_writeb(mregs, MUSB_DEVCTL,
  209. devctl | MUSB_DEVCTL_SESSION);
  210. devctl = musb_readb(mregs, MUSB_DEVCTL);
  211. if (devctl & MUSB_DEVCTL_BDEVICE)
  212. mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
  213. else
  214. musb->xceiv->state = OTG_STATE_A_IDLE;
  215. break;
  216. default:
  217. break;
  218. }
  219. spin_unlock_irqrestore(&musb->lock, flags);
  220. }
  221. static irqreturn_t davinci_musb_interrupt(int irq, void *__hci)
  222. {
  223. unsigned long flags;
  224. irqreturn_t retval = IRQ_NONE;
  225. struct musb *musb = __hci;
  226. struct usb_otg *otg = musb->xceiv->otg;
  227. void __iomem *tibase = musb->ctrl_base;
  228. struct cppi *cppi;
  229. u32 tmp;
  230. spin_lock_irqsave(&musb->lock, flags);
  231. /* NOTE: DaVinci shadows the Mentor IRQs. Don't manage them through
  232. * the Mentor registers (except for setup), use the TI ones and EOI.
  233. *
  234. * Docs describe irq "vector" registers associated with the CPPI and
  235. * USB EOI registers. These hold a bitmask corresponding to the
  236. * current IRQ, not an irq handler address. Would using those bits
  237. * resolve some of the races observed in this dispatch code??
  238. */
  239. /* CPPI interrupts share the same IRQ line, but have their own
  240. * mask, state, "vector", and EOI registers.
  241. */
  242. cppi = container_of(musb->dma_controller, struct cppi, controller);
  243. if (is_cppi_enabled() && musb->dma_controller && !cppi->irq)
  244. retval = cppi_interrupt(irq, __hci);
  245. /* ack and handle non-CPPI interrupts */
  246. tmp = musb_readl(tibase, DAVINCI_USB_INT_SRC_MASKED_REG);
  247. musb_writel(tibase, DAVINCI_USB_INT_SRC_CLR_REG, tmp);
  248. dev_dbg(musb->controller, "IRQ %08x\n", tmp);
  249. musb->int_rx = (tmp & DAVINCI_USB_RXINT_MASK)
  250. >> DAVINCI_USB_RXINT_SHIFT;
  251. musb->int_tx = (tmp & DAVINCI_USB_TXINT_MASK)
  252. >> DAVINCI_USB_TXINT_SHIFT;
  253. musb->int_usb = (tmp & DAVINCI_USB_USBINT_MASK)
  254. >> DAVINCI_USB_USBINT_SHIFT;
  255. /* DRVVBUS irqs are the only proxy we have (a very poor one!) for
  256. * DaVinci's missing ID change IRQ. We need an ID change IRQ to
  257. * switch appropriately between halves of the OTG state machine.
  258. * Managing DEVCTL.SESSION per Mentor docs requires we know its
  259. * value, but DEVCTL.BDEVICE is invalid without DEVCTL.SESSION set.
  260. * Also, DRVVBUS pulses for SRP (but not at 5V) ...
  261. */
  262. if (tmp & (DAVINCI_INTR_DRVVBUS << DAVINCI_USB_USBINT_SHIFT)) {
  263. int drvvbus = musb_readl(tibase, DAVINCI_USB_STAT_REG);
  264. void __iomem *mregs = musb->mregs;
  265. u8 devctl = musb_readb(mregs, MUSB_DEVCTL);
  266. int err = musb->int_usb & MUSB_INTR_VBUSERROR;
  267. err = is_host_enabled(musb)
  268. && (musb->int_usb & MUSB_INTR_VBUSERROR);
  269. if (err) {
  270. /* The Mentor core doesn't debounce VBUS as needed
  271. * to cope with device connect current spikes. This
  272. * means it's not uncommon for bus-powered devices
  273. * to get VBUS errors during enumeration.
  274. *
  275. * This is a workaround, but newer RTL from Mentor
  276. * seems to allow a better one: "re"starting sessions
  277. * without waiting (on EVM, a **long** time) for VBUS
  278. * to stop registering in devctl.
  279. */
  280. musb->int_usb &= ~MUSB_INTR_VBUSERROR;
  281. musb->xceiv->state = OTG_STATE_A_WAIT_VFALL;
  282. mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
  283. WARNING("VBUS error workaround (delay coming)\n");
  284. } else if (is_host_enabled(musb) && drvvbus) {
  285. MUSB_HST_MODE(musb);
  286. otg->default_a = 1;
  287. musb->xceiv->state = OTG_STATE_A_WAIT_VRISE;
  288. portstate(musb->port1_status |= USB_PORT_STAT_POWER);
  289. del_timer(&otg_workaround);
  290. } else {
  291. musb->is_active = 0;
  292. MUSB_DEV_MODE(musb);
  293. otg->default_a = 0;
  294. musb->xceiv->state = OTG_STATE_B_IDLE;
  295. portstate(musb->port1_status &= ~USB_PORT_STAT_POWER);
  296. }
  297. /* NOTE: this must complete poweron within 100 msec
  298. * (OTG_TIME_A_WAIT_VRISE) but we don't check for that.
  299. */
  300. davinci_musb_source_power(musb, drvvbus, 0);
  301. dev_dbg(musb->controller, "VBUS %s (%s)%s, devctl %02x\n",
  302. drvvbus ? "on" : "off",
  303. otg_state_string(musb->xceiv->state),
  304. err ? " ERROR" : "",
  305. devctl);
  306. retval = IRQ_HANDLED;
  307. }
  308. if (musb->int_tx || musb->int_rx || musb->int_usb)
  309. retval |= musb_interrupt(musb);
  310. /* irq stays asserted until EOI is written */
  311. musb_writel(tibase, DAVINCI_USB_EOI_REG, 0);
  312. /* poll for ID change */
  313. if (is_otg_enabled(musb)
  314. && musb->xceiv->state == OTG_STATE_B_IDLE)
  315. mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
  316. spin_unlock_irqrestore(&musb->lock, flags);
  317. return retval;
  318. }
  319. static int davinci_musb_set_mode(struct musb *musb, u8 mode)
  320. {
  321. /* EVM can't do this (right?) */
  322. return -EIO;
  323. }
  324. static int davinci_musb_init(struct musb *musb)
  325. {
  326. void __iomem *tibase = musb->ctrl_base;
  327. u32 revision;
  328. usb_nop_xceiv_register();
  329. musb->xceiv = usb_get_transceiver();
  330. if (!musb->xceiv)
  331. goto unregister;
  332. musb->mregs += DAVINCI_BASE_OFFSET;
  333. /* returns zero if e.g. not clocked */
  334. revision = musb_readl(tibase, DAVINCI_USB_VERSION_REG);
  335. if (revision == 0)
  336. goto fail;
  337. if (is_host_enabled(musb))
  338. setup_timer(&otg_workaround, otg_timer, (unsigned long) musb);
  339. davinci_musb_source_power(musb, 0, 1);
  340. /* dm355 EVM swaps D+/D- for signal integrity, and
  341. * is clocked from the main 24 MHz crystal.
  342. */
  343. if (machine_is_davinci_dm355_evm()) {
  344. u32 phy_ctrl = __raw_readl(USB_PHY_CTRL);
  345. phy_ctrl &= ~(3 << 9);
  346. phy_ctrl |= USBPHY_DATAPOL;
  347. __raw_writel(phy_ctrl, USB_PHY_CTRL);
  348. }
  349. /* On dm355, the default-A state machine needs DRVVBUS control.
  350. * If we won't be a host, there's no need to turn it on.
  351. */
  352. if (cpu_is_davinci_dm355()) {
  353. u32 deepsleep = __raw_readl(DM355_DEEPSLEEP);
  354. if (is_host_enabled(musb)) {
  355. deepsleep &= ~DRVVBUS_OVERRIDE;
  356. } else {
  357. deepsleep &= ~DRVVBUS_FORCE;
  358. deepsleep |= DRVVBUS_OVERRIDE;
  359. }
  360. __raw_writel(deepsleep, DM355_DEEPSLEEP);
  361. }
  362. /* reset the controller */
  363. musb_writel(tibase, DAVINCI_USB_CTRL_REG, 0x1);
  364. /* start the on-chip PHY and its PLL */
  365. phy_on();
  366. msleep(5);
  367. /* NOTE: irqs are in mixed mode, not bypass to pure-musb */
  368. pr_debug("DaVinci OTG revision %08x phy %03x control %02x\n",
  369. revision, __raw_readl(USB_PHY_CTRL),
  370. musb_readb(tibase, DAVINCI_USB_CTRL_REG));
  371. musb->isr = davinci_musb_interrupt;
  372. return 0;
  373. fail:
  374. usb_put_transceiver(musb->xceiv);
  375. unregister:
  376. usb_nop_xceiv_unregister();
  377. return -ENODEV;
  378. }
  379. static int davinci_musb_exit(struct musb *musb)
  380. {
  381. if (is_host_enabled(musb))
  382. del_timer_sync(&otg_workaround);
  383. /* force VBUS off */
  384. if (cpu_is_davinci_dm355()) {
  385. u32 deepsleep = __raw_readl(DM355_DEEPSLEEP);
  386. deepsleep &= ~DRVVBUS_FORCE;
  387. deepsleep |= DRVVBUS_OVERRIDE;
  388. __raw_writel(deepsleep, DM355_DEEPSLEEP);
  389. }
  390. davinci_musb_source_power(musb, 0 /*off*/, 1);
  391. /* delay, to avoid problems with module reload */
  392. if (is_host_enabled(musb) && musb->xceiv->otg->default_a) {
  393. int maxdelay = 30;
  394. u8 devctl, warn = 0;
  395. /* if there's no peripheral connected, this can take a
  396. * long time to fall, especially on EVM with huge C133.
  397. */
  398. do {
  399. devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
  400. if (!(devctl & MUSB_DEVCTL_VBUS))
  401. break;
  402. if ((devctl & MUSB_DEVCTL_VBUS) != warn) {
  403. warn = devctl & MUSB_DEVCTL_VBUS;
  404. dev_dbg(musb->controller, "VBUS %d\n",
  405. warn >> MUSB_DEVCTL_VBUS_SHIFT);
  406. }
  407. msleep(1000);
  408. maxdelay--;
  409. } while (maxdelay > 0);
  410. /* in OTG mode, another host might be connected */
  411. if (devctl & MUSB_DEVCTL_VBUS)
  412. dev_dbg(musb->controller, "VBUS off timeout (devctl %02x)\n", devctl);
  413. }
  414. phy_off();
  415. usb_put_transceiver(musb->xceiv);
  416. usb_nop_xceiv_unregister();
  417. return 0;
  418. }
  419. static const struct musb_platform_ops davinci_ops = {
  420. .init = davinci_musb_init,
  421. .exit = davinci_musb_exit,
  422. .enable = davinci_musb_enable,
  423. .disable = davinci_musb_disable,
  424. .set_mode = davinci_musb_set_mode,
  425. .set_vbus = davinci_musb_set_vbus,
  426. };
  427. static u64 davinci_dmamask = DMA_BIT_MASK(32);
  428. static int __devinit davinci_probe(struct platform_device *pdev)
  429. {
  430. struct musb_hdrc_platform_data *pdata = pdev->dev.platform_data;
  431. struct platform_device *musb;
  432. struct davinci_glue *glue;
  433. struct clk *clk;
  434. int ret = -ENOMEM;
  435. glue = kzalloc(sizeof(*glue), GFP_KERNEL);
  436. if (!glue) {
  437. dev_err(&pdev->dev, "failed to allocate glue context\n");
  438. goto err0;
  439. }
  440. musb = platform_device_alloc("musb-hdrc", -1);
  441. if (!musb) {
  442. dev_err(&pdev->dev, "failed to allocate musb device\n");
  443. goto err1;
  444. }
  445. clk = clk_get(&pdev->dev, "usb");
  446. if (IS_ERR(clk)) {
  447. dev_err(&pdev->dev, "failed to get clock\n");
  448. ret = PTR_ERR(clk);
  449. goto err2;
  450. }
  451. ret = clk_enable(clk);
  452. if (ret) {
  453. dev_err(&pdev->dev, "failed to enable clock\n");
  454. goto err3;
  455. }
  456. musb->dev.parent = &pdev->dev;
  457. musb->dev.dma_mask = &davinci_dmamask;
  458. musb->dev.coherent_dma_mask = davinci_dmamask;
  459. glue->dev = &pdev->dev;
  460. glue->musb = musb;
  461. glue->clk = clk;
  462. pdata->platform_ops = &davinci_ops;
  463. platform_set_drvdata(pdev, glue);
  464. ret = platform_device_add_resources(musb, pdev->resource,
  465. pdev->num_resources);
  466. if (ret) {
  467. dev_err(&pdev->dev, "failed to add resources\n");
  468. goto err4;
  469. }
  470. ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
  471. if (ret) {
  472. dev_err(&pdev->dev, "failed to add platform_data\n");
  473. goto err4;
  474. }
  475. ret = platform_device_add(musb);
  476. if (ret) {
  477. dev_err(&pdev->dev, "failed to register musb device\n");
  478. goto err4;
  479. }
  480. return 0;
  481. err4:
  482. clk_disable(clk);
  483. err3:
  484. clk_put(clk);
  485. err2:
  486. platform_device_put(musb);
  487. err1:
  488. kfree(glue);
  489. err0:
  490. return ret;
  491. }
  492. static int __devexit davinci_remove(struct platform_device *pdev)
  493. {
  494. struct davinci_glue *glue = platform_get_drvdata(pdev);
  495. platform_device_del(glue->musb);
  496. platform_device_put(glue->musb);
  497. clk_disable(glue->clk);
  498. clk_put(glue->clk);
  499. kfree(glue);
  500. return 0;
  501. }
  502. static struct platform_driver davinci_driver = {
  503. .probe = davinci_probe,
  504. .remove = __devexit_p(davinci_remove),
  505. .driver = {
  506. .name = "musb-davinci",
  507. },
  508. };
  509. MODULE_DESCRIPTION("DaVinci MUSB Glue Layer");
  510. MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
  511. MODULE_LICENSE("GPL v2");
  512. static int __init davinci_init(void)
  513. {
  514. return platform_driver_register(&davinci_driver);
  515. }
  516. module_init(davinci_init);
  517. static void __exit davinci_exit(void)
  518. {
  519. platform_driver_unregister(&davinci_driver);
  520. }
  521. module_exit(davinci_exit);