musb_dsps.c 27 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093
  1. /*
  2. * Texas Instruments DSPS platforms "glue layer"
  3. *
  4. * Copyright (C) 2012, by Texas Instruments
  5. *
  6. * Based on the am35x "glue layer" code.
  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. * musb_dsps.c will be a common file for all the TI DSPS platforms
  27. * such as dm64x, dm36x, dm35x, da8x, am35x and ti81x.
  28. * For now only ti81x is using this and in future davinci.c, am35x.c
  29. * da8xx.c would be merged to this file after testing.
  30. */
  31. #include <linux/io.h>
  32. #include <linux/err.h>
  33. #include <linux/platform_device.h>
  34. #include <linux/dma-mapping.h>
  35. #include <linux/pm_runtime.h>
  36. #include <linux/module.h>
  37. #include <linux/usb/usb_phy_generic.h>
  38. #include <linux/platform_data/usb-omap.h>
  39. #include <linux/sizes.h>
  40. #include <linux/of.h>
  41. #include <linux/of_device.h>
  42. #include <linux/of_address.h>
  43. #include <linux/of_irq.h>
  44. #include <linux/usb/of.h>
  45. #include <linux/debugfs.h>
  46. #include "musb_core.h"
  47. static const struct of_device_id musb_dsps_of_match[];
  48. /**
  49. * DSPS musb wrapper register offset.
  50. * FIXME: This should be expanded to have all the wrapper registers from TI DSPS
  51. * musb ips.
  52. */
  53. struct dsps_musb_wrapper {
  54. u16 revision;
  55. u16 control;
  56. u16 status;
  57. u16 epintr_set;
  58. u16 epintr_clear;
  59. u16 epintr_status;
  60. u16 coreintr_set;
  61. u16 coreintr_clear;
  62. u16 coreintr_status;
  63. u16 phy_utmi;
  64. u16 mode;
  65. u16 tx_mode;
  66. u16 rx_mode;
  67. /* bit positions for control */
  68. unsigned reset:5;
  69. /* bit positions for interrupt */
  70. unsigned usb_shift:5;
  71. u32 usb_mask;
  72. u32 usb_bitmap;
  73. unsigned drvvbus:5;
  74. unsigned txep_shift:5;
  75. u32 txep_mask;
  76. u32 txep_bitmap;
  77. unsigned rxep_shift:5;
  78. u32 rxep_mask;
  79. u32 rxep_bitmap;
  80. /* bit positions for phy_utmi */
  81. unsigned otg_disable:5;
  82. /* bit positions for mode */
  83. unsigned iddig:5;
  84. unsigned iddig_mux:5;
  85. /* miscellaneous stuff */
  86. unsigned poll_timeout;
  87. };
  88. /*
  89. * register shadow for suspend
  90. */
  91. struct dsps_context {
  92. u32 control;
  93. u32 epintr;
  94. u32 coreintr;
  95. u32 phy_utmi;
  96. u32 mode;
  97. u32 tx_mode;
  98. u32 rx_mode;
  99. };
  100. /**
  101. * DSPS glue structure.
  102. */
  103. struct dsps_glue {
  104. struct device *dev;
  105. struct platform_device *musb; /* child musb pdev */
  106. const struct dsps_musb_wrapper *wrp; /* wrapper register offsets */
  107. int vbus_irq; /* optional vbus irq */
  108. struct timer_list timer; /* otg_workaround timer */
  109. unsigned long last_timer; /* last timer data for each instance */
  110. bool sw_babble_enabled;
  111. void __iomem *usbss_base;
  112. struct dsps_context context;
  113. struct debugfs_regset32 regset;
  114. struct dentry *dbgfs_root;
  115. };
  116. static const struct debugfs_reg32 dsps_musb_regs[] = {
  117. { "revision", 0x00 },
  118. { "control", 0x14 },
  119. { "status", 0x18 },
  120. { "eoi", 0x24 },
  121. { "intr0_stat", 0x30 },
  122. { "intr1_stat", 0x34 },
  123. { "intr0_set", 0x38 },
  124. { "intr1_set", 0x3c },
  125. { "txmode", 0x70 },
  126. { "rxmode", 0x74 },
  127. { "autoreq", 0xd0 },
  128. { "srpfixtime", 0xd4 },
  129. { "tdown", 0xd8 },
  130. { "phy_utmi", 0xe0 },
  131. { "mode", 0xe8 },
  132. };
  133. static void dsps_mod_timer(struct dsps_glue *glue, int wait_ms)
  134. {
  135. int wait;
  136. if (wait_ms < 0)
  137. wait = msecs_to_jiffies(glue->wrp->poll_timeout);
  138. else
  139. wait = msecs_to_jiffies(wait_ms);
  140. mod_timer(&glue->timer, jiffies + wait);
  141. }
  142. /*
  143. * If no vbus irq from the PMIC is configured, we need to poll VBUS status.
  144. */
  145. static void dsps_mod_timer_optional(struct dsps_glue *glue)
  146. {
  147. if (glue->vbus_irq)
  148. return;
  149. dsps_mod_timer(glue, -1);
  150. }
  151. /* USBSS / USB AM335x */
  152. #define USBSS_IRQ_STATUS 0x28
  153. #define USBSS_IRQ_ENABLER 0x2c
  154. #define USBSS_IRQ_CLEARR 0x30
  155. #define USBSS_IRQ_PD_COMP (1 << 2)
  156. /**
  157. * dsps_musb_enable - enable interrupts
  158. */
  159. static void dsps_musb_enable(struct musb *musb)
  160. {
  161. struct device *dev = musb->controller;
  162. struct platform_device *pdev = to_platform_device(dev->parent);
  163. struct dsps_glue *glue = platform_get_drvdata(pdev);
  164. const struct dsps_musb_wrapper *wrp = glue->wrp;
  165. void __iomem *reg_base = musb->ctrl_base;
  166. u32 epmask, coremask;
  167. /* Workaround: setup IRQs through both register sets. */
  168. epmask = ((musb->epmask & wrp->txep_mask) << wrp->txep_shift) |
  169. ((musb->epmask & wrp->rxep_mask) << wrp->rxep_shift);
  170. coremask = (wrp->usb_bitmap & ~MUSB_INTR_SOF);
  171. musb_writel(reg_base, wrp->epintr_set, epmask);
  172. musb_writel(reg_base, wrp->coreintr_set, coremask);
  173. /* start polling for ID change in dual-role idle mode */
  174. if (musb->xceiv->otg->state == OTG_STATE_B_IDLE &&
  175. musb->port_mode == MUSB_PORT_MODE_DUAL_ROLE)
  176. dsps_mod_timer(glue, -1);
  177. }
  178. /**
  179. * dsps_musb_disable - disable HDRC and flush interrupts
  180. */
  181. static void dsps_musb_disable(struct musb *musb)
  182. {
  183. struct device *dev = musb->controller;
  184. struct platform_device *pdev = to_platform_device(dev->parent);
  185. struct dsps_glue *glue = platform_get_drvdata(pdev);
  186. const struct dsps_musb_wrapper *wrp = glue->wrp;
  187. void __iomem *reg_base = musb->ctrl_base;
  188. musb_writel(reg_base, wrp->coreintr_clear, wrp->usb_bitmap);
  189. musb_writel(reg_base, wrp->epintr_clear,
  190. wrp->txep_bitmap | wrp->rxep_bitmap);
  191. del_timer_sync(&glue->timer);
  192. }
  193. /* Caller must take musb->lock */
  194. static int dsps_check_status(struct musb *musb, void *unused)
  195. {
  196. void __iomem *mregs = musb->mregs;
  197. struct device *dev = musb->controller;
  198. struct dsps_glue *glue = dev_get_drvdata(dev->parent);
  199. const struct dsps_musb_wrapper *wrp = glue->wrp;
  200. u8 devctl;
  201. int skip_session = 0;
  202. if (glue->vbus_irq)
  203. del_timer(&glue->timer);
  204. /*
  205. * We poll because DSPS IP's won't expose several OTG-critical
  206. * status change events (from the transceiver) otherwise.
  207. */
  208. devctl = musb_readb(mregs, MUSB_DEVCTL);
  209. dev_dbg(musb->controller, "Poll devctl %02x (%s)\n", devctl,
  210. usb_otg_state_string(musb->xceiv->otg->state));
  211. switch (musb->xceiv->otg->state) {
  212. case OTG_STATE_A_WAIT_VRISE:
  213. dsps_mod_timer_optional(glue);
  214. break;
  215. case OTG_STATE_A_WAIT_BCON:
  216. /* keep VBUS on for host-only mode */
  217. if (musb->port_mode == MUSB_PORT_MODE_HOST) {
  218. dsps_mod_timer_optional(glue);
  219. break;
  220. }
  221. musb_writeb(musb->mregs, MUSB_DEVCTL, 0);
  222. skip_session = 1;
  223. /* fall */
  224. case OTG_STATE_A_IDLE:
  225. case OTG_STATE_B_IDLE:
  226. if (!glue->vbus_irq) {
  227. if (devctl & MUSB_DEVCTL_BDEVICE) {
  228. musb->xceiv->otg->state = OTG_STATE_B_IDLE;
  229. MUSB_DEV_MODE(musb);
  230. } else {
  231. musb->xceiv->otg->state = OTG_STATE_A_IDLE;
  232. MUSB_HST_MODE(musb);
  233. }
  234. if (!(devctl & MUSB_DEVCTL_SESSION) && !skip_session)
  235. musb_writeb(mregs, MUSB_DEVCTL,
  236. MUSB_DEVCTL_SESSION);
  237. }
  238. dsps_mod_timer_optional(glue);
  239. break;
  240. case OTG_STATE_A_WAIT_VFALL:
  241. musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
  242. musb_writel(musb->ctrl_base, wrp->coreintr_set,
  243. MUSB_INTR_VBUSERROR << wrp->usb_shift);
  244. break;
  245. default:
  246. break;
  247. }
  248. return 0;
  249. }
  250. static void otg_timer(unsigned long _musb)
  251. {
  252. struct musb *musb = (void *)_musb;
  253. struct device *dev = musb->controller;
  254. unsigned long flags;
  255. int err;
  256. err = pm_runtime_get(dev);
  257. if ((err != -EINPROGRESS) && err < 0) {
  258. dev_err(dev, "Poll could not pm_runtime_get: %i\n", err);
  259. pm_runtime_put_noidle(dev);
  260. return;
  261. }
  262. spin_lock_irqsave(&musb->lock, flags);
  263. err = musb_queue_resume_work(musb, dsps_check_status, NULL);
  264. if (err < 0)
  265. dev_err(dev, "%s resume work: %i\n", __func__, err);
  266. spin_unlock_irqrestore(&musb->lock, flags);
  267. pm_runtime_mark_last_busy(dev);
  268. pm_runtime_put_autosuspend(dev);
  269. }
  270. static void dsps_musb_clear_ep_rxintr(struct musb *musb, int epnum)
  271. {
  272. u32 epintr;
  273. struct dsps_glue *glue = dev_get_drvdata(musb->controller->parent);
  274. const struct dsps_musb_wrapper *wrp = glue->wrp;
  275. /* musb->lock might already been held */
  276. epintr = (1 << epnum) << wrp->rxep_shift;
  277. musb_writel(musb->ctrl_base, wrp->epintr_status, epintr);
  278. }
  279. static irqreturn_t dsps_interrupt(int irq, void *hci)
  280. {
  281. struct musb *musb = hci;
  282. void __iomem *reg_base = musb->ctrl_base;
  283. struct device *dev = musb->controller;
  284. struct dsps_glue *glue = dev_get_drvdata(dev->parent);
  285. const struct dsps_musb_wrapper *wrp = glue->wrp;
  286. unsigned long flags;
  287. irqreturn_t ret = IRQ_NONE;
  288. u32 epintr, usbintr;
  289. spin_lock_irqsave(&musb->lock, flags);
  290. /* Get endpoint interrupts */
  291. epintr = musb_readl(reg_base, wrp->epintr_status);
  292. musb->int_rx = (epintr & wrp->rxep_bitmap) >> wrp->rxep_shift;
  293. musb->int_tx = (epintr & wrp->txep_bitmap) >> wrp->txep_shift;
  294. if (epintr)
  295. musb_writel(reg_base, wrp->epintr_status, epintr);
  296. /* Get usb core interrupts */
  297. usbintr = musb_readl(reg_base, wrp->coreintr_status);
  298. if (!usbintr && !epintr)
  299. goto out;
  300. musb->int_usb = (usbintr & wrp->usb_bitmap) >> wrp->usb_shift;
  301. if (usbintr)
  302. musb_writel(reg_base, wrp->coreintr_status, usbintr);
  303. dev_dbg(musb->controller, "usbintr (%x) epintr(%x)\n",
  304. usbintr, epintr);
  305. if (usbintr & ((1 << wrp->drvvbus) << wrp->usb_shift)) {
  306. int drvvbus = musb_readl(reg_base, wrp->status);
  307. void __iomem *mregs = musb->mregs;
  308. u8 devctl = musb_readb(mregs, MUSB_DEVCTL);
  309. int err;
  310. err = musb->int_usb & MUSB_INTR_VBUSERROR;
  311. if (err) {
  312. /*
  313. * The Mentor core doesn't debounce VBUS as needed
  314. * to cope with device connect current spikes. This
  315. * means it's not uncommon for bus-powered devices
  316. * to get VBUS errors during enumeration.
  317. *
  318. * This is a workaround, but newer RTL from Mentor
  319. * seems to allow a better one: "re"-starting sessions
  320. * without waiting for VBUS to stop registering in
  321. * devctl.
  322. */
  323. musb->int_usb &= ~MUSB_INTR_VBUSERROR;
  324. musb->xceiv->otg->state = OTG_STATE_A_WAIT_VFALL;
  325. dsps_mod_timer_optional(glue);
  326. WARNING("VBUS error workaround (delay coming)\n");
  327. } else if (drvvbus) {
  328. MUSB_HST_MODE(musb);
  329. musb->xceiv->otg->default_a = 1;
  330. musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
  331. dsps_mod_timer_optional(glue);
  332. } else {
  333. musb->is_active = 0;
  334. MUSB_DEV_MODE(musb);
  335. musb->xceiv->otg->default_a = 0;
  336. musb->xceiv->otg->state = OTG_STATE_B_IDLE;
  337. }
  338. /* NOTE: this must complete power-on within 100 ms. */
  339. dev_dbg(musb->controller, "VBUS %s (%s)%s, devctl %02x\n",
  340. drvvbus ? "on" : "off",
  341. usb_otg_state_string(musb->xceiv->otg->state),
  342. err ? " ERROR" : "",
  343. devctl);
  344. ret = IRQ_HANDLED;
  345. }
  346. if (musb->int_tx || musb->int_rx || musb->int_usb)
  347. ret |= musb_interrupt(musb);
  348. /* Poll for ID change and connect */
  349. switch (musb->xceiv->otg->state) {
  350. case OTG_STATE_B_IDLE:
  351. case OTG_STATE_A_WAIT_BCON:
  352. dsps_mod_timer_optional(glue);
  353. break;
  354. default:
  355. break;
  356. }
  357. out:
  358. spin_unlock_irqrestore(&musb->lock, flags);
  359. return ret;
  360. }
  361. static int dsps_musb_dbg_init(struct musb *musb, struct dsps_glue *glue)
  362. {
  363. struct dentry *root;
  364. struct dentry *file;
  365. char buf[128];
  366. sprintf(buf, "%s.dsps", dev_name(musb->controller));
  367. root = debugfs_create_dir(buf, NULL);
  368. if (!root)
  369. return -ENOMEM;
  370. glue->dbgfs_root = root;
  371. glue->regset.regs = dsps_musb_regs;
  372. glue->regset.nregs = ARRAY_SIZE(dsps_musb_regs);
  373. glue->regset.base = musb->ctrl_base;
  374. file = debugfs_create_regset32("regdump", S_IRUGO, root, &glue->regset);
  375. if (!file) {
  376. debugfs_remove_recursive(root);
  377. return -ENOMEM;
  378. }
  379. return 0;
  380. }
  381. static int dsps_musb_init(struct musb *musb)
  382. {
  383. struct device *dev = musb->controller;
  384. struct dsps_glue *glue = dev_get_drvdata(dev->parent);
  385. struct platform_device *parent = to_platform_device(dev->parent);
  386. const struct dsps_musb_wrapper *wrp = glue->wrp;
  387. void __iomem *reg_base;
  388. struct resource *r;
  389. u32 rev, val;
  390. int ret;
  391. r = platform_get_resource_byname(parent, IORESOURCE_MEM, "control");
  392. reg_base = devm_ioremap_resource(dev, r);
  393. if (IS_ERR(reg_base))
  394. return PTR_ERR(reg_base);
  395. musb->ctrl_base = reg_base;
  396. /* NOP driver needs change if supporting dual instance */
  397. musb->xceiv = devm_usb_get_phy_by_phandle(dev->parent, "phys", 0);
  398. if (IS_ERR(musb->xceiv))
  399. return PTR_ERR(musb->xceiv);
  400. musb->phy = devm_phy_get(dev->parent, "usb2-phy");
  401. /* Returns zero if e.g. not clocked */
  402. rev = musb_readl(reg_base, wrp->revision);
  403. if (!rev)
  404. return -ENODEV;
  405. usb_phy_init(musb->xceiv);
  406. if (IS_ERR(musb->phy)) {
  407. musb->phy = NULL;
  408. } else {
  409. ret = phy_init(musb->phy);
  410. if (ret < 0)
  411. return ret;
  412. ret = phy_power_on(musb->phy);
  413. if (ret) {
  414. phy_exit(musb->phy);
  415. return ret;
  416. }
  417. }
  418. setup_timer(&glue->timer, otg_timer, (unsigned long) musb);
  419. /* Reset the musb */
  420. musb_writel(reg_base, wrp->control, (1 << wrp->reset));
  421. musb->isr = dsps_interrupt;
  422. /* reset the otgdisable bit, needed for host mode to work */
  423. val = musb_readl(reg_base, wrp->phy_utmi);
  424. val &= ~(1 << wrp->otg_disable);
  425. musb_writel(musb->ctrl_base, wrp->phy_utmi, val);
  426. /*
  427. * Check whether the dsps version has babble control enabled.
  428. * In latest silicon revision the babble control logic is enabled.
  429. * If MUSB_BABBLE_CTL returns 0x4 then we have the babble control
  430. * logic enabled.
  431. */
  432. val = musb_readb(musb->mregs, MUSB_BABBLE_CTL);
  433. if (val & MUSB_BABBLE_RCV_DISABLE) {
  434. glue->sw_babble_enabled = true;
  435. val |= MUSB_BABBLE_SW_SESSION_CTRL;
  436. musb_writeb(musb->mregs, MUSB_BABBLE_CTL, val);
  437. }
  438. dsps_mod_timer(glue, -1);
  439. return dsps_musb_dbg_init(musb, glue);
  440. }
  441. static int dsps_musb_exit(struct musb *musb)
  442. {
  443. struct device *dev = musb->controller;
  444. struct dsps_glue *glue = dev_get_drvdata(dev->parent);
  445. del_timer_sync(&glue->timer);
  446. usb_phy_shutdown(musb->xceiv);
  447. phy_power_off(musb->phy);
  448. phy_exit(musb->phy);
  449. debugfs_remove_recursive(glue->dbgfs_root);
  450. return 0;
  451. }
  452. static int dsps_musb_set_mode(struct musb *musb, u8 mode)
  453. {
  454. struct device *dev = musb->controller;
  455. struct dsps_glue *glue = dev_get_drvdata(dev->parent);
  456. const struct dsps_musb_wrapper *wrp = glue->wrp;
  457. void __iomem *ctrl_base = musb->ctrl_base;
  458. u32 reg;
  459. reg = musb_readl(ctrl_base, wrp->mode);
  460. switch (mode) {
  461. case MUSB_HOST:
  462. reg &= ~(1 << wrp->iddig);
  463. /*
  464. * if we're setting mode to host-only or device-only, we're
  465. * going to ignore whatever the PHY sends us and just force
  466. * ID pin status by SW
  467. */
  468. reg |= (1 << wrp->iddig_mux);
  469. musb_writel(ctrl_base, wrp->mode, reg);
  470. musb_writel(ctrl_base, wrp->phy_utmi, 0x02);
  471. break;
  472. case MUSB_PERIPHERAL:
  473. reg |= (1 << wrp->iddig);
  474. /*
  475. * if we're setting mode to host-only or device-only, we're
  476. * going to ignore whatever the PHY sends us and just force
  477. * ID pin status by SW
  478. */
  479. reg |= (1 << wrp->iddig_mux);
  480. musb_writel(ctrl_base, wrp->mode, reg);
  481. break;
  482. case MUSB_OTG:
  483. musb_writel(ctrl_base, wrp->phy_utmi, 0x02);
  484. break;
  485. default:
  486. dev_err(glue->dev, "unsupported mode %d\n", mode);
  487. return -EINVAL;
  488. }
  489. return 0;
  490. }
  491. static bool dsps_sw_babble_control(struct musb *musb)
  492. {
  493. u8 babble_ctl;
  494. bool session_restart = false;
  495. babble_ctl = musb_readb(musb->mregs, MUSB_BABBLE_CTL);
  496. dev_dbg(musb->controller, "babble: MUSB_BABBLE_CTL value %x\n",
  497. babble_ctl);
  498. /*
  499. * check line monitor flag to check whether babble is
  500. * due to noise
  501. */
  502. dev_dbg(musb->controller, "STUCK_J is %s\n",
  503. babble_ctl & MUSB_BABBLE_STUCK_J ? "set" : "reset");
  504. if (babble_ctl & MUSB_BABBLE_STUCK_J) {
  505. int timeout = 10;
  506. /*
  507. * babble is due to noise, then set transmit idle (d7 bit)
  508. * to resume normal operation
  509. */
  510. babble_ctl = musb_readb(musb->mregs, MUSB_BABBLE_CTL);
  511. babble_ctl |= MUSB_BABBLE_FORCE_TXIDLE;
  512. musb_writeb(musb->mregs, MUSB_BABBLE_CTL, babble_ctl);
  513. /* wait till line monitor flag cleared */
  514. dev_dbg(musb->controller, "Set TXIDLE, wait J to clear\n");
  515. do {
  516. babble_ctl = musb_readb(musb->mregs, MUSB_BABBLE_CTL);
  517. udelay(1);
  518. } while ((babble_ctl & MUSB_BABBLE_STUCK_J) && timeout--);
  519. /* check whether stuck_at_j bit cleared */
  520. if (babble_ctl & MUSB_BABBLE_STUCK_J) {
  521. /*
  522. * real babble condition has occurred
  523. * restart the controller to start the
  524. * session again
  525. */
  526. dev_dbg(musb->controller, "J not cleared, misc (%x)\n",
  527. babble_ctl);
  528. session_restart = true;
  529. }
  530. } else {
  531. session_restart = true;
  532. }
  533. return session_restart;
  534. }
  535. static int dsps_musb_recover(struct musb *musb)
  536. {
  537. struct device *dev = musb->controller;
  538. struct dsps_glue *glue = dev_get_drvdata(dev->parent);
  539. int session_restart = 0;
  540. if (glue->sw_babble_enabled)
  541. session_restart = dsps_sw_babble_control(musb);
  542. else
  543. session_restart = 1;
  544. return session_restart ? 0 : -EPIPE;
  545. }
  546. /* Similar to am35x, dm81xx support only 32-bit read operation */
  547. static void dsps_read_fifo32(struct musb_hw_ep *hw_ep, u16 len, u8 *dst)
  548. {
  549. void __iomem *fifo = hw_ep->fifo;
  550. if (len >= 4) {
  551. ioread32_rep(fifo, dst, len >> 2);
  552. dst += len & ~0x03;
  553. len &= 0x03;
  554. }
  555. /* Read any remaining 1 to 3 bytes */
  556. if (len > 0) {
  557. u32 val = musb_readl(fifo, 0);
  558. memcpy(dst, &val, len);
  559. }
  560. }
  561. #ifdef CONFIG_USB_TI_CPPI41_DMA
  562. static void dsps_dma_controller_callback(struct dma_controller *c)
  563. {
  564. struct musb *musb = c->musb;
  565. struct dsps_glue *glue = dev_get_drvdata(musb->controller->parent);
  566. void __iomem *usbss_base = glue->usbss_base;
  567. u32 status;
  568. status = musb_readl(usbss_base, USBSS_IRQ_STATUS);
  569. if (status & USBSS_IRQ_PD_COMP)
  570. musb_writel(usbss_base, USBSS_IRQ_STATUS, USBSS_IRQ_PD_COMP);
  571. }
  572. static struct dma_controller *
  573. dsps_dma_controller_create(struct musb *musb, void __iomem *base)
  574. {
  575. struct dma_controller *controller;
  576. struct dsps_glue *glue = dev_get_drvdata(musb->controller->parent);
  577. void __iomem *usbss_base = glue->usbss_base;
  578. controller = cppi41_dma_controller_create(musb, base);
  579. if (IS_ERR_OR_NULL(controller))
  580. return controller;
  581. musb_writel(usbss_base, USBSS_IRQ_ENABLER, USBSS_IRQ_PD_COMP);
  582. controller->dma_callback = dsps_dma_controller_callback;
  583. return controller;
  584. }
  585. static void dsps_dma_controller_destroy(struct dma_controller *c)
  586. {
  587. struct musb *musb = c->musb;
  588. struct dsps_glue *glue = dev_get_drvdata(musb->controller->parent);
  589. void __iomem *usbss_base = glue->usbss_base;
  590. musb_writel(usbss_base, USBSS_IRQ_CLEARR, USBSS_IRQ_PD_COMP);
  591. cppi41_dma_controller_destroy(c);
  592. }
  593. #ifdef CONFIG_PM_SLEEP
  594. static void dsps_dma_controller_suspend(struct dsps_glue *glue)
  595. {
  596. void __iomem *usbss_base = glue->usbss_base;
  597. musb_writel(usbss_base, USBSS_IRQ_CLEARR, USBSS_IRQ_PD_COMP);
  598. }
  599. static void dsps_dma_controller_resume(struct dsps_glue *glue)
  600. {
  601. void __iomem *usbss_base = glue->usbss_base;
  602. musb_writel(usbss_base, USBSS_IRQ_ENABLER, USBSS_IRQ_PD_COMP);
  603. }
  604. #endif
  605. #else /* CONFIG_USB_TI_CPPI41_DMA */
  606. #ifdef CONFIG_PM_SLEEP
  607. static void dsps_dma_controller_suspend(struct dsps_glue *glue) {}
  608. static void dsps_dma_controller_resume(struct dsps_glue *glue) {}
  609. #endif
  610. #endif /* CONFIG_USB_TI_CPPI41_DMA */
  611. static struct musb_platform_ops dsps_ops = {
  612. .quirks = MUSB_DMA_CPPI41 | MUSB_INDEXED_EP,
  613. .init = dsps_musb_init,
  614. .exit = dsps_musb_exit,
  615. #ifdef CONFIG_USB_TI_CPPI41_DMA
  616. .dma_init = dsps_dma_controller_create,
  617. .dma_exit = dsps_dma_controller_destroy,
  618. #endif
  619. .enable = dsps_musb_enable,
  620. .disable = dsps_musb_disable,
  621. .set_mode = dsps_musb_set_mode,
  622. .recover = dsps_musb_recover,
  623. .clear_ep_rxintr = dsps_musb_clear_ep_rxintr,
  624. };
  625. static u64 musb_dmamask = DMA_BIT_MASK(32);
  626. static int get_int_prop(struct device_node *dn, const char *s)
  627. {
  628. int ret;
  629. u32 val;
  630. ret = of_property_read_u32(dn, s, &val);
  631. if (ret)
  632. return 0;
  633. return val;
  634. }
  635. static int get_musb_port_mode(struct device *dev)
  636. {
  637. enum usb_dr_mode mode;
  638. mode = usb_get_dr_mode(dev);
  639. switch (mode) {
  640. case USB_DR_MODE_HOST:
  641. return MUSB_PORT_MODE_HOST;
  642. case USB_DR_MODE_PERIPHERAL:
  643. return MUSB_PORT_MODE_GADGET;
  644. case USB_DR_MODE_UNKNOWN:
  645. case USB_DR_MODE_OTG:
  646. default:
  647. return MUSB_PORT_MODE_DUAL_ROLE;
  648. }
  649. }
  650. static int dsps_create_musb_pdev(struct dsps_glue *glue,
  651. struct platform_device *parent)
  652. {
  653. struct musb_hdrc_platform_data pdata;
  654. struct resource resources[2];
  655. struct resource *res;
  656. struct device *dev = &parent->dev;
  657. struct musb_hdrc_config *config;
  658. struct platform_device *musb;
  659. struct device_node *dn = parent->dev.of_node;
  660. int ret, val;
  661. memset(resources, 0, sizeof(resources));
  662. res = platform_get_resource_byname(parent, IORESOURCE_MEM, "mc");
  663. if (!res) {
  664. dev_err(dev, "failed to get memory.\n");
  665. return -EINVAL;
  666. }
  667. resources[0] = *res;
  668. res = platform_get_resource_byname(parent, IORESOURCE_IRQ, "mc");
  669. if (!res) {
  670. dev_err(dev, "failed to get irq.\n");
  671. return -EINVAL;
  672. }
  673. resources[1] = *res;
  674. /* allocate the child platform device */
  675. musb = platform_device_alloc("musb-hdrc",
  676. (resources[0].start & 0xFFF) == 0x400 ? 0 : 1);
  677. if (!musb) {
  678. dev_err(dev, "failed to allocate musb device\n");
  679. return -ENOMEM;
  680. }
  681. musb->dev.parent = dev;
  682. musb->dev.dma_mask = &musb_dmamask;
  683. musb->dev.coherent_dma_mask = musb_dmamask;
  684. glue->musb = musb;
  685. ret = platform_device_add_resources(musb, resources,
  686. ARRAY_SIZE(resources));
  687. if (ret) {
  688. dev_err(dev, "failed to add resources\n");
  689. goto err;
  690. }
  691. config = devm_kzalloc(&parent->dev, sizeof(*config), GFP_KERNEL);
  692. if (!config) {
  693. ret = -ENOMEM;
  694. goto err;
  695. }
  696. pdata.config = config;
  697. pdata.platform_ops = &dsps_ops;
  698. config->num_eps = get_int_prop(dn, "mentor,num-eps");
  699. config->ram_bits = get_int_prop(dn, "mentor,ram-bits");
  700. config->host_port_deassert_reset_at_resume = 1;
  701. pdata.mode = get_musb_port_mode(dev);
  702. /* DT keeps this entry in mA, musb expects it as per USB spec */
  703. pdata.power = get_int_prop(dn, "mentor,power") / 2;
  704. ret = of_property_read_u32(dn, "mentor,multipoint", &val);
  705. if (!ret && val)
  706. config->multipoint = true;
  707. config->maximum_speed = usb_get_maximum_speed(&parent->dev);
  708. switch (config->maximum_speed) {
  709. case USB_SPEED_LOW:
  710. case USB_SPEED_FULL:
  711. break;
  712. case USB_SPEED_SUPER:
  713. dev_warn(dev, "ignore incorrect maximum_speed "
  714. "(super-speed) setting in dts");
  715. /* fall through */
  716. default:
  717. config->maximum_speed = USB_SPEED_HIGH;
  718. }
  719. ret = platform_device_add_data(musb, &pdata, sizeof(pdata));
  720. if (ret) {
  721. dev_err(dev, "failed to add platform_data\n");
  722. goto err;
  723. }
  724. ret = platform_device_add(musb);
  725. if (ret) {
  726. dev_err(dev, "failed to register musb device\n");
  727. goto err;
  728. }
  729. return 0;
  730. err:
  731. platform_device_put(musb);
  732. return ret;
  733. }
  734. static irqreturn_t dsps_vbus_threaded_irq(int irq, void *priv)
  735. {
  736. struct dsps_glue *glue = priv;
  737. struct musb *musb = platform_get_drvdata(glue->musb);
  738. if (!musb)
  739. return IRQ_NONE;
  740. dev_dbg(glue->dev, "VBUS interrupt\n");
  741. dsps_mod_timer(glue, 0);
  742. return IRQ_HANDLED;
  743. }
  744. static int dsps_setup_optional_vbus_irq(struct platform_device *pdev,
  745. struct dsps_glue *glue)
  746. {
  747. int error;
  748. glue->vbus_irq = platform_get_irq_byname(pdev, "vbus");
  749. if (glue->vbus_irq == -EPROBE_DEFER)
  750. return -EPROBE_DEFER;
  751. if (glue->vbus_irq <= 0) {
  752. glue->vbus_irq = 0;
  753. return 0;
  754. }
  755. error = devm_request_threaded_irq(glue->dev, glue->vbus_irq,
  756. NULL, dsps_vbus_threaded_irq,
  757. IRQF_ONESHOT,
  758. "vbus", glue);
  759. if (error) {
  760. glue->vbus_irq = 0;
  761. return error;
  762. }
  763. dev_dbg(glue->dev, "VBUS irq %i configured\n", glue->vbus_irq);
  764. return 0;
  765. }
  766. static int dsps_probe(struct platform_device *pdev)
  767. {
  768. const struct of_device_id *match;
  769. const struct dsps_musb_wrapper *wrp;
  770. struct dsps_glue *glue;
  771. int ret;
  772. if (!strcmp(pdev->name, "musb-hdrc"))
  773. return -ENODEV;
  774. match = of_match_node(musb_dsps_of_match, pdev->dev.of_node);
  775. if (!match) {
  776. dev_err(&pdev->dev, "fail to get matching of_match struct\n");
  777. return -EINVAL;
  778. }
  779. wrp = match->data;
  780. if (of_device_is_compatible(pdev->dev.of_node, "ti,musb-dm816"))
  781. dsps_ops.read_fifo = dsps_read_fifo32;
  782. /* allocate glue */
  783. glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL);
  784. if (!glue)
  785. return -ENOMEM;
  786. glue->dev = &pdev->dev;
  787. glue->wrp = wrp;
  788. glue->usbss_base = of_iomap(pdev->dev.parent->of_node, 0);
  789. if (!glue->usbss_base)
  790. return -ENXIO;
  791. if (usb_get_dr_mode(&pdev->dev) == USB_DR_MODE_PERIPHERAL) {
  792. ret = dsps_setup_optional_vbus_irq(pdev, glue);
  793. if (ret)
  794. goto err_iounmap;
  795. }
  796. platform_set_drvdata(pdev, glue);
  797. pm_runtime_enable(&pdev->dev);
  798. ret = dsps_create_musb_pdev(glue, pdev);
  799. if (ret)
  800. goto err;
  801. return 0;
  802. err:
  803. pm_runtime_disable(&pdev->dev);
  804. err_iounmap:
  805. iounmap(glue->usbss_base);
  806. return ret;
  807. }
  808. static int dsps_remove(struct platform_device *pdev)
  809. {
  810. struct dsps_glue *glue = platform_get_drvdata(pdev);
  811. platform_device_unregister(glue->musb);
  812. pm_runtime_disable(&pdev->dev);
  813. iounmap(glue->usbss_base);
  814. return 0;
  815. }
  816. static const struct dsps_musb_wrapper am33xx_driver_data = {
  817. .revision = 0x00,
  818. .control = 0x14,
  819. .status = 0x18,
  820. .epintr_set = 0x38,
  821. .epintr_clear = 0x40,
  822. .epintr_status = 0x30,
  823. .coreintr_set = 0x3c,
  824. .coreintr_clear = 0x44,
  825. .coreintr_status = 0x34,
  826. .phy_utmi = 0xe0,
  827. .mode = 0xe8,
  828. .tx_mode = 0x70,
  829. .rx_mode = 0x74,
  830. .reset = 0,
  831. .otg_disable = 21,
  832. .iddig = 8,
  833. .iddig_mux = 7,
  834. .usb_shift = 0,
  835. .usb_mask = 0x1ff,
  836. .usb_bitmap = (0x1ff << 0),
  837. .drvvbus = 8,
  838. .txep_shift = 0,
  839. .txep_mask = 0xffff,
  840. .txep_bitmap = (0xffff << 0),
  841. .rxep_shift = 16,
  842. .rxep_mask = 0xfffe,
  843. .rxep_bitmap = (0xfffe << 16),
  844. .poll_timeout = 2000, /* ms */
  845. };
  846. static const struct of_device_id musb_dsps_of_match[] = {
  847. { .compatible = "ti,musb-am33xx",
  848. .data = &am33xx_driver_data, },
  849. { .compatible = "ti,musb-dm816",
  850. .data = &am33xx_driver_data, },
  851. { },
  852. };
  853. MODULE_DEVICE_TABLE(of, musb_dsps_of_match);
  854. #ifdef CONFIG_PM_SLEEP
  855. static int dsps_suspend(struct device *dev)
  856. {
  857. struct dsps_glue *glue = dev_get_drvdata(dev);
  858. const struct dsps_musb_wrapper *wrp = glue->wrp;
  859. struct musb *musb = platform_get_drvdata(glue->musb);
  860. void __iomem *mbase;
  861. int ret;
  862. if (!musb)
  863. /* This can happen if the musb device is in -EPROBE_DEFER */
  864. return 0;
  865. ret = pm_runtime_get_sync(dev);
  866. if (ret < 0) {
  867. pm_runtime_put_noidle(dev);
  868. return ret;
  869. }
  870. del_timer_sync(&glue->timer);
  871. mbase = musb->ctrl_base;
  872. glue->context.control = musb_readl(mbase, wrp->control);
  873. glue->context.epintr = musb_readl(mbase, wrp->epintr_set);
  874. glue->context.coreintr = musb_readl(mbase, wrp->coreintr_set);
  875. glue->context.phy_utmi = musb_readl(mbase, wrp->phy_utmi);
  876. glue->context.mode = musb_readl(mbase, wrp->mode);
  877. glue->context.tx_mode = musb_readl(mbase, wrp->tx_mode);
  878. glue->context.rx_mode = musb_readl(mbase, wrp->rx_mode);
  879. dsps_dma_controller_suspend(glue);
  880. return 0;
  881. }
  882. static int dsps_resume(struct device *dev)
  883. {
  884. struct dsps_glue *glue = dev_get_drvdata(dev);
  885. const struct dsps_musb_wrapper *wrp = glue->wrp;
  886. struct musb *musb = platform_get_drvdata(glue->musb);
  887. void __iomem *mbase;
  888. if (!musb)
  889. return 0;
  890. dsps_dma_controller_resume(glue);
  891. mbase = musb->ctrl_base;
  892. musb_writel(mbase, wrp->control, glue->context.control);
  893. musb_writel(mbase, wrp->epintr_set, glue->context.epintr);
  894. musb_writel(mbase, wrp->coreintr_set, glue->context.coreintr);
  895. musb_writel(mbase, wrp->phy_utmi, glue->context.phy_utmi);
  896. musb_writel(mbase, wrp->mode, glue->context.mode);
  897. musb_writel(mbase, wrp->tx_mode, glue->context.tx_mode);
  898. musb_writel(mbase, wrp->rx_mode, glue->context.rx_mode);
  899. if (musb->xceiv->otg->state == OTG_STATE_B_IDLE &&
  900. musb->port_mode == MUSB_PORT_MODE_DUAL_ROLE)
  901. dsps_mod_timer(glue, -1);
  902. pm_runtime_put(dev);
  903. return 0;
  904. }
  905. #endif
  906. static SIMPLE_DEV_PM_OPS(dsps_pm_ops, dsps_suspend, dsps_resume);
  907. static struct platform_driver dsps_usbss_driver = {
  908. .probe = dsps_probe,
  909. .remove = dsps_remove,
  910. .driver = {
  911. .name = "musb-dsps",
  912. .pm = &dsps_pm_ops,
  913. .of_match_table = musb_dsps_of_match,
  914. },
  915. };
  916. MODULE_DESCRIPTION("TI DSPS MUSB Glue Layer");
  917. MODULE_AUTHOR("Ravi B <ravibabu@ti.com>");
  918. MODULE_AUTHOR("Ajay Kumar Gupta <ajay.gupta@ti.com>");
  919. MODULE_LICENSE("GPL v2");
  920. module_platform_driver(dsps_usbss_driver);