musb_dsps.c 24 KB

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