tusb6010_omap.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719
  1. /*
  2. * TUSB6010 USB 2.0 OTG Dual Role controller OMAP DMA interface
  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. #include <linux/module.h>
  12. #include <linux/kernel.h>
  13. #include <linux/errno.h>
  14. #include <linux/init.h>
  15. #include <linux/usb.h>
  16. #include <linux/platform_device.h>
  17. #include <linux/dma-mapping.h>
  18. #include <asm/arch/dma.h>
  19. #include <asm/arch/mux.h>
  20. #include "musb_core.h"
  21. #define to_chdat(c) ((struct tusb_omap_dma_ch *)(c)->private_data)
  22. #define MAX_DMAREQ 5 /* REVISIT: Really 6, but req5 not OK */
  23. struct tusb_omap_dma_ch {
  24. struct musb *musb;
  25. void __iomem *tbase;
  26. unsigned long phys_offset;
  27. int epnum;
  28. u8 tx;
  29. struct musb_hw_ep *hw_ep;
  30. int ch;
  31. s8 dmareq;
  32. s8 sync_dev;
  33. struct tusb_omap_dma *tusb_dma;
  34. void __iomem *dma_addr;
  35. u32 len;
  36. u16 packet_sz;
  37. u16 transfer_packet_sz;
  38. u32 transfer_len;
  39. u32 completed_len;
  40. };
  41. struct tusb_omap_dma {
  42. struct dma_controller controller;
  43. struct musb *musb;
  44. void __iomem *tbase;
  45. int ch;
  46. s8 dmareq;
  47. s8 sync_dev;
  48. unsigned multichannel:1;
  49. };
  50. static int tusb_omap_dma_start(struct dma_controller *c)
  51. {
  52. struct tusb_omap_dma *tusb_dma;
  53. tusb_dma = container_of(c, struct tusb_omap_dma, controller);
  54. /* DBG(3, "ep%i ch: %i\n", chdat->epnum, chdat->ch); */
  55. return 0;
  56. }
  57. static int tusb_omap_dma_stop(struct dma_controller *c)
  58. {
  59. struct tusb_omap_dma *tusb_dma;
  60. tusb_dma = container_of(c, struct tusb_omap_dma, controller);
  61. /* DBG(3, "ep%i ch: %i\n", chdat->epnum, chdat->ch); */
  62. return 0;
  63. }
  64. /*
  65. * Allocate dmareq0 to the current channel unless it's already taken
  66. */
  67. static inline int tusb_omap_use_shared_dmareq(struct tusb_omap_dma_ch *chdat)
  68. {
  69. u32 reg = musb_readl(chdat->tbase, TUSB_DMA_EP_MAP);
  70. if (reg != 0) {
  71. DBG(3, "ep%i dmareq0 is busy for ep%i\n",
  72. chdat->epnum, reg & 0xf);
  73. return -EAGAIN;
  74. }
  75. if (chdat->tx)
  76. reg = (1 << 4) | chdat->epnum;
  77. else
  78. reg = chdat->epnum;
  79. musb_writel(chdat->tbase, TUSB_DMA_EP_MAP, reg);
  80. return 0;
  81. }
  82. static inline void tusb_omap_free_shared_dmareq(struct tusb_omap_dma_ch *chdat)
  83. {
  84. u32 reg = musb_readl(chdat->tbase, TUSB_DMA_EP_MAP);
  85. if ((reg & 0xf) != chdat->epnum) {
  86. printk(KERN_ERR "ep%i trying to release dmareq0 for ep%i\n",
  87. chdat->epnum, reg & 0xf);
  88. return;
  89. }
  90. musb_writel(chdat->tbase, TUSB_DMA_EP_MAP, 0);
  91. }
  92. /*
  93. * See also musb_dma_completion in plat_uds.c and musb_g_[tx|rx]() in
  94. * musb_gadget.c.
  95. */
  96. static void tusb_omap_dma_cb(int lch, u16 ch_status, void *data)
  97. {
  98. struct dma_channel *channel = (struct dma_channel *)data;
  99. struct tusb_omap_dma_ch *chdat = to_chdat(channel);
  100. struct tusb_omap_dma *tusb_dma = chdat->tusb_dma;
  101. struct musb *musb = chdat->musb;
  102. struct musb_hw_ep *hw_ep = chdat->hw_ep;
  103. void __iomem *ep_conf = hw_ep->conf;
  104. void __iomem *mbase = musb->mregs;
  105. unsigned long remaining, flags, pio;
  106. int ch;
  107. spin_lock_irqsave(&musb->lock, flags);
  108. if (tusb_dma->multichannel)
  109. ch = chdat->ch;
  110. else
  111. ch = tusb_dma->ch;
  112. if (ch_status != OMAP_DMA_BLOCK_IRQ)
  113. printk(KERN_ERR "TUSB DMA error status: %i\n", ch_status);
  114. DBG(3, "ep%i %s dma callback ch: %i status: %x\n",
  115. chdat->epnum, chdat->tx ? "tx" : "rx",
  116. ch, ch_status);
  117. if (chdat->tx)
  118. remaining = musb_readl(ep_conf, TUSB_EP_TX_OFFSET);
  119. else
  120. remaining = musb_readl(ep_conf, TUSB_EP_RX_OFFSET);
  121. remaining = TUSB_EP_CONFIG_XFR_SIZE(remaining);
  122. /* HW issue #10: XFR_SIZE may get corrupt on DMA (both async & sync) */
  123. if (unlikely(remaining > chdat->transfer_len)) {
  124. DBG(2, "Corrupt %s dma ch%i XFR_SIZE: 0x%08lx\n",
  125. chdat->tx ? "tx" : "rx", chdat->ch,
  126. remaining);
  127. remaining = 0;
  128. }
  129. channel->actual_len = chdat->transfer_len - remaining;
  130. pio = chdat->len - channel->actual_len;
  131. DBG(3, "DMA remaining %lu/%u\n", remaining, chdat->transfer_len);
  132. /* Transfer remaining 1 - 31 bytes */
  133. if (pio > 0 && pio < 32) {
  134. u8 *buf;
  135. DBG(3, "Using PIO for remaining %lu bytes\n", pio);
  136. buf = phys_to_virt((u32)chdat->dma_addr) + chdat->transfer_len;
  137. if (chdat->tx) {
  138. dma_cache_maint(phys_to_virt((u32)chdat->dma_addr),
  139. chdat->transfer_len, DMA_TO_DEVICE);
  140. musb_write_fifo(hw_ep, pio, buf);
  141. } else {
  142. musb_read_fifo(hw_ep, pio, buf);
  143. dma_cache_maint(phys_to_virt((u32)chdat->dma_addr),
  144. chdat->transfer_len, DMA_FROM_DEVICE);
  145. }
  146. channel->actual_len += pio;
  147. }
  148. if (!tusb_dma->multichannel)
  149. tusb_omap_free_shared_dmareq(chdat);
  150. channel->status = MUSB_DMA_STATUS_FREE;
  151. /* Handle only RX callbacks here. TX callbacks must be handled based
  152. * on the TUSB DMA status interrupt.
  153. * REVISIT: Use both TUSB DMA status interrupt and OMAP DMA callback
  154. * interrupt for RX and TX.
  155. */
  156. if (!chdat->tx)
  157. musb_dma_completion(musb, chdat->epnum, chdat->tx);
  158. /* We must terminate short tx transfers manually by setting TXPKTRDY.
  159. * REVISIT: This same problem may occur with other MUSB dma as well.
  160. * Easy to test with g_ether by pinging the MUSB board with ping -s54.
  161. */
  162. if ((chdat->transfer_len < chdat->packet_sz)
  163. || (chdat->transfer_len % chdat->packet_sz != 0)) {
  164. u16 csr;
  165. if (chdat->tx) {
  166. DBG(3, "terminating short tx packet\n");
  167. musb_ep_select(mbase, chdat->epnum);
  168. csr = musb_readw(hw_ep->regs, MUSB_TXCSR);
  169. csr |= MUSB_TXCSR_MODE | MUSB_TXCSR_TXPKTRDY
  170. | MUSB_TXCSR_P_WZC_BITS;
  171. musb_writew(hw_ep->regs, MUSB_TXCSR, csr);
  172. }
  173. }
  174. spin_unlock_irqrestore(&musb->lock, flags);
  175. }
  176. static int tusb_omap_dma_program(struct dma_channel *channel, u16 packet_sz,
  177. u8 rndis_mode, dma_addr_t dma_addr, u32 len)
  178. {
  179. struct tusb_omap_dma_ch *chdat = to_chdat(channel);
  180. struct tusb_omap_dma *tusb_dma = chdat->tusb_dma;
  181. struct musb *musb = chdat->musb;
  182. struct musb_hw_ep *hw_ep = chdat->hw_ep;
  183. void __iomem *mbase = musb->mregs;
  184. void __iomem *ep_conf = hw_ep->conf;
  185. dma_addr_t fifo = hw_ep->fifo_sync;
  186. struct omap_dma_channel_params dma_params;
  187. u32 dma_remaining;
  188. int src_burst, dst_burst;
  189. u16 csr;
  190. int ch;
  191. s8 dmareq;
  192. s8 sync_dev;
  193. if (unlikely(dma_addr & 0x1) || (len < 32) || (len > packet_sz))
  194. return false;
  195. /*
  196. * HW issue #10: Async dma will eventually corrupt the XFR_SIZE
  197. * register which will cause missed DMA interrupt. We could try to
  198. * use a timer for the callback, but it is unsafe as the XFR_SIZE
  199. * register is corrupt, and we won't know if the DMA worked.
  200. */
  201. if (dma_addr & 0x2)
  202. return false;
  203. /*
  204. * Because of HW issue #10, it seems like mixing sync DMA and async
  205. * PIO access can confuse the DMA. Make sure XFR_SIZE is reset before
  206. * using the channel for DMA.
  207. */
  208. if (chdat->tx)
  209. dma_remaining = musb_readl(ep_conf, TUSB_EP_TX_OFFSET);
  210. else
  211. dma_remaining = musb_readl(ep_conf, TUSB_EP_RX_OFFSET);
  212. dma_remaining = TUSB_EP_CONFIG_XFR_SIZE(dma_remaining);
  213. if (dma_remaining) {
  214. DBG(2, "Busy %s dma ch%i, not using: %08x\n",
  215. chdat->tx ? "tx" : "rx", chdat->ch,
  216. dma_remaining);
  217. return false;
  218. }
  219. chdat->transfer_len = len & ~0x1f;
  220. if (len < packet_sz)
  221. chdat->transfer_packet_sz = chdat->transfer_len;
  222. else
  223. chdat->transfer_packet_sz = packet_sz;
  224. if (tusb_dma->multichannel) {
  225. ch = chdat->ch;
  226. dmareq = chdat->dmareq;
  227. sync_dev = chdat->sync_dev;
  228. } else {
  229. if (tusb_omap_use_shared_dmareq(chdat) != 0) {
  230. DBG(3, "could not get dma for ep%i\n", chdat->epnum);
  231. return false;
  232. }
  233. if (tusb_dma->ch < 0) {
  234. /* REVISIT: This should get blocked earlier, happens
  235. * with MSC ErrorRecoveryTest
  236. */
  237. WARN_ON(1);
  238. return false;
  239. }
  240. ch = tusb_dma->ch;
  241. dmareq = tusb_dma->dmareq;
  242. sync_dev = tusb_dma->sync_dev;
  243. omap_set_dma_callback(ch, tusb_omap_dma_cb, channel);
  244. }
  245. chdat->packet_sz = packet_sz;
  246. chdat->len = len;
  247. channel->actual_len = 0;
  248. chdat->dma_addr = (void __iomem *)dma_addr;
  249. channel->status = MUSB_DMA_STATUS_BUSY;
  250. /* Since we're recycling dma areas, we need to clean or invalidate */
  251. if (chdat->tx)
  252. dma_cache_maint(phys_to_virt(dma_addr), len, DMA_TO_DEVICE);
  253. else
  254. dma_cache_maint(phys_to_virt(dma_addr), len, DMA_FROM_DEVICE);
  255. /* Use 16-bit transfer if dma_addr is not 32-bit aligned */
  256. if ((dma_addr & 0x3) == 0) {
  257. dma_params.data_type = OMAP_DMA_DATA_TYPE_S32;
  258. dma_params.elem_count = 8; /* Elements in frame */
  259. } else {
  260. dma_params.data_type = OMAP_DMA_DATA_TYPE_S16;
  261. dma_params.elem_count = 16; /* Elements in frame */
  262. fifo = hw_ep->fifo_async;
  263. }
  264. dma_params.frame_count = chdat->transfer_len / 32; /* Burst sz frame */
  265. DBG(3, "ep%i %s dma ch%i dma: %08x len: %u(%u) packet_sz: %i(%i)\n",
  266. chdat->epnum, chdat->tx ? "tx" : "rx",
  267. ch, dma_addr, chdat->transfer_len, len,
  268. chdat->transfer_packet_sz, packet_sz);
  269. /*
  270. * Prepare omap DMA for transfer
  271. */
  272. if (chdat->tx) {
  273. dma_params.src_amode = OMAP_DMA_AMODE_POST_INC;
  274. dma_params.src_start = (unsigned long)dma_addr;
  275. dma_params.src_ei = 0;
  276. dma_params.src_fi = 0;
  277. dma_params.dst_amode = OMAP_DMA_AMODE_DOUBLE_IDX;
  278. dma_params.dst_start = (unsigned long)fifo;
  279. dma_params.dst_ei = 1;
  280. dma_params.dst_fi = -31; /* Loop 32 byte window */
  281. dma_params.trigger = sync_dev;
  282. dma_params.sync_mode = OMAP_DMA_SYNC_FRAME;
  283. dma_params.src_or_dst_synch = 0; /* Dest sync */
  284. src_burst = OMAP_DMA_DATA_BURST_16; /* 16x32 read */
  285. dst_burst = OMAP_DMA_DATA_BURST_8; /* 8x32 write */
  286. } else {
  287. dma_params.src_amode = OMAP_DMA_AMODE_DOUBLE_IDX;
  288. dma_params.src_start = (unsigned long)fifo;
  289. dma_params.src_ei = 1;
  290. dma_params.src_fi = -31; /* Loop 32 byte window */
  291. dma_params.dst_amode = OMAP_DMA_AMODE_POST_INC;
  292. dma_params.dst_start = (unsigned long)dma_addr;
  293. dma_params.dst_ei = 0;
  294. dma_params.dst_fi = 0;
  295. dma_params.trigger = sync_dev;
  296. dma_params.sync_mode = OMAP_DMA_SYNC_FRAME;
  297. dma_params.src_or_dst_synch = 1; /* Source sync */
  298. src_burst = OMAP_DMA_DATA_BURST_8; /* 8x32 read */
  299. dst_burst = OMAP_DMA_DATA_BURST_16; /* 16x32 write */
  300. }
  301. DBG(3, "ep%i %s using %i-bit %s dma from 0x%08lx to 0x%08lx\n",
  302. chdat->epnum, chdat->tx ? "tx" : "rx",
  303. (dma_params.data_type == OMAP_DMA_DATA_TYPE_S32) ? 32 : 16,
  304. ((dma_addr & 0x3) == 0) ? "sync" : "async",
  305. dma_params.src_start, dma_params.dst_start);
  306. omap_set_dma_params(ch, &dma_params);
  307. omap_set_dma_src_burst_mode(ch, src_burst);
  308. omap_set_dma_dest_burst_mode(ch, dst_burst);
  309. omap_set_dma_write_mode(ch, OMAP_DMA_WRITE_LAST_NON_POSTED);
  310. /*
  311. * Prepare MUSB for DMA transfer
  312. */
  313. if (chdat->tx) {
  314. musb_ep_select(mbase, chdat->epnum);
  315. csr = musb_readw(hw_ep->regs, MUSB_TXCSR);
  316. csr |= (MUSB_TXCSR_AUTOSET | MUSB_TXCSR_DMAENAB
  317. | MUSB_TXCSR_DMAMODE | MUSB_TXCSR_MODE);
  318. csr &= ~MUSB_TXCSR_P_UNDERRUN;
  319. musb_writew(hw_ep->regs, MUSB_TXCSR, csr);
  320. } else {
  321. musb_ep_select(mbase, chdat->epnum);
  322. csr = musb_readw(hw_ep->regs, MUSB_RXCSR);
  323. csr |= MUSB_RXCSR_DMAENAB;
  324. csr &= ~(MUSB_RXCSR_AUTOCLEAR | MUSB_RXCSR_DMAMODE);
  325. musb_writew(hw_ep->regs, MUSB_RXCSR,
  326. csr | MUSB_RXCSR_P_WZC_BITS);
  327. }
  328. /*
  329. * Start DMA transfer
  330. */
  331. omap_start_dma(ch);
  332. if (chdat->tx) {
  333. /* Send transfer_packet_sz packets at a time */
  334. musb_writel(ep_conf, TUSB_EP_MAX_PACKET_SIZE_OFFSET,
  335. chdat->transfer_packet_sz);
  336. musb_writel(ep_conf, TUSB_EP_TX_OFFSET,
  337. TUSB_EP_CONFIG_XFR_SIZE(chdat->transfer_len));
  338. } else {
  339. /* Receive transfer_packet_sz packets at a time */
  340. musb_writel(ep_conf, TUSB_EP_MAX_PACKET_SIZE_OFFSET,
  341. chdat->transfer_packet_sz << 16);
  342. musb_writel(ep_conf, TUSB_EP_RX_OFFSET,
  343. TUSB_EP_CONFIG_XFR_SIZE(chdat->transfer_len));
  344. }
  345. return true;
  346. }
  347. static int tusb_omap_dma_abort(struct dma_channel *channel)
  348. {
  349. struct tusb_omap_dma_ch *chdat = to_chdat(channel);
  350. struct tusb_omap_dma *tusb_dma = chdat->tusb_dma;
  351. if (!tusb_dma->multichannel) {
  352. if (tusb_dma->ch >= 0) {
  353. omap_stop_dma(tusb_dma->ch);
  354. omap_free_dma(tusb_dma->ch);
  355. tusb_dma->ch = -1;
  356. }
  357. tusb_dma->dmareq = -1;
  358. tusb_dma->sync_dev = -1;
  359. }
  360. channel->status = MUSB_DMA_STATUS_FREE;
  361. return 0;
  362. }
  363. static inline int tusb_omap_dma_allocate_dmareq(struct tusb_omap_dma_ch *chdat)
  364. {
  365. u32 reg = musb_readl(chdat->tbase, TUSB_DMA_EP_MAP);
  366. int i, dmareq_nr = -1;
  367. const int sync_dev[6] = {
  368. OMAP24XX_DMA_EXT_DMAREQ0,
  369. OMAP24XX_DMA_EXT_DMAREQ1,
  370. OMAP242X_DMA_EXT_DMAREQ2,
  371. OMAP242X_DMA_EXT_DMAREQ3,
  372. OMAP242X_DMA_EXT_DMAREQ4,
  373. OMAP242X_DMA_EXT_DMAREQ5,
  374. };
  375. for (i = 0; i < MAX_DMAREQ; i++) {
  376. int cur = (reg & (0xf << (i * 5))) >> (i * 5);
  377. if (cur == 0) {
  378. dmareq_nr = i;
  379. break;
  380. }
  381. }
  382. if (dmareq_nr == -1)
  383. return -EAGAIN;
  384. reg |= (chdat->epnum << (dmareq_nr * 5));
  385. if (chdat->tx)
  386. reg |= ((1 << 4) << (dmareq_nr * 5));
  387. musb_writel(chdat->tbase, TUSB_DMA_EP_MAP, reg);
  388. chdat->dmareq = dmareq_nr;
  389. chdat->sync_dev = sync_dev[chdat->dmareq];
  390. return 0;
  391. }
  392. static inline void tusb_omap_dma_free_dmareq(struct tusb_omap_dma_ch *chdat)
  393. {
  394. u32 reg;
  395. if (!chdat || chdat->dmareq < 0)
  396. return;
  397. reg = musb_readl(chdat->tbase, TUSB_DMA_EP_MAP);
  398. reg &= ~(0x1f << (chdat->dmareq * 5));
  399. musb_writel(chdat->tbase, TUSB_DMA_EP_MAP, reg);
  400. chdat->dmareq = -1;
  401. chdat->sync_dev = -1;
  402. }
  403. static struct dma_channel *dma_channel_pool[MAX_DMAREQ];
  404. static struct dma_channel *
  405. tusb_omap_dma_allocate(struct dma_controller *c,
  406. struct musb_hw_ep *hw_ep,
  407. u8 tx)
  408. {
  409. int ret, i;
  410. const char *dev_name;
  411. struct tusb_omap_dma *tusb_dma;
  412. struct musb *musb;
  413. void __iomem *tbase;
  414. struct dma_channel *channel = NULL;
  415. struct tusb_omap_dma_ch *chdat = NULL;
  416. u32 reg;
  417. tusb_dma = container_of(c, struct tusb_omap_dma, controller);
  418. musb = tusb_dma->musb;
  419. tbase = musb->ctrl_base;
  420. reg = musb_readl(tbase, TUSB_DMA_INT_MASK);
  421. if (tx)
  422. reg &= ~(1 << hw_ep->epnum);
  423. else
  424. reg &= ~(1 << (hw_ep->epnum + 15));
  425. musb_writel(tbase, TUSB_DMA_INT_MASK, reg);
  426. /* REVISIT: Why does dmareq5 not work? */
  427. if (hw_ep->epnum == 0) {
  428. DBG(3, "Not allowing DMA for ep0 %s\n", tx ? "tx" : "rx");
  429. return NULL;
  430. }
  431. for (i = 0; i < MAX_DMAREQ; i++) {
  432. struct dma_channel *ch = dma_channel_pool[i];
  433. if (ch->status == MUSB_DMA_STATUS_UNKNOWN) {
  434. ch->status = MUSB_DMA_STATUS_FREE;
  435. channel = ch;
  436. chdat = ch->private_data;
  437. break;
  438. }
  439. }
  440. if (!channel)
  441. return NULL;
  442. if (tx) {
  443. chdat->tx = 1;
  444. dev_name = "TUSB transmit";
  445. } else {
  446. chdat->tx = 0;
  447. dev_name = "TUSB receive";
  448. }
  449. chdat->musb = tusb_dma->musb;
  450. chdat->tbase = tusb_dma->tbase;
  451. chdat->hw_ep = hw_ep;
  452. chdat->epnum = hw_ep->epnum;
  453. chdat->dmareq = -1;
  454. chdat->completed_len = 0;
  455. chdat->tusb_dma = tusb_dma;
  456. channel->max_len = 0x7fffffff;
  457. channel->desired_mode = 0;
  458. channel->actual_len = 0;
  459. if (tusb_dma->multichannel) {
  460. ret = tusb_omap_dma_allocate_dmareq(chdat);
  461. if (ret != 0)
  462. goto free_dmareq;
  463. ret = omap_request_dma(chdat->sync_dev, dev_name,
  464. tusb_omap_dma_cb, channel, &chdat->ch);
  465. if (ret != 0)
  466. goto free_dmareq;
  467. } else if (tusb_dma->ch == -1) {
  468. tusb_dma->dmareq = 0;
  469. tusb_dma->sync_dev = OMAP24XX_DMA_EXT_DMAREQ0;
  470. /* Callback data gets set later in the shared dmareq case */
  471. ret = omap_request_dma(tusb_dma->sync_dev, "TUSB shared",
  472. tusb_omap_dma_cb, NULL, &tusb_dma->ch);
  473. if (ret != 0)
  474. goto free_dmareq;
  475. chdat->dmareq = -1;
  476. chdat->ch = -1;
  477. }
  478. DBG(3, "ep%i %s dma: %s dma%i dmareq%i sync%i\n",
  479. chdat->epnum,
  480. chdat->tx ? "tx" : "rx",
  481. chdat->ch >= 0 ? "dedicated" : "shared",
  482. chdat->ch >= 0 ? chdat->ch : tusb_dma->ch,
  483. chdat->dmareq >= 0 ? chdat->dmareq : tusb_dma->dmareq,
  484. chdat->sync_dev >= 0 ? chdat->sync_dev : tusb_dma->sync_dev);
  485. return channel;
  486. free_dmareq:
  487. tusb_omap_dma_free_dmareq(chdat);
  488. DBG(3, "ep%i: Could not get a DMA channel\n", chdat->epnum);
  489. channel->status = MUSB_DMA_STATUS_UNKNOWN;
  490. return NULL;
  491. }
  492. static void tusb_omap_dma_release(struct dma_channel *channel)
  493. {
  494. struct tusb_omap_dma_ch *chdat = to_chdat(channel);
  495. struct musb *musb = chdat->musb;
  496. void __iomem *tbase = musb->ctrl_base;
  497. u32 reg;
  498. DBG(3, "ep%i ch%i\n", chdat->epnum, chdat->ch);
  499. reg = musb_readl(tbase, TUSB_DMA_INT_MASK);
  500. if (chdat->tx)
  501. reg |= (1 << chdat->epnum);
  502. else
  503. reg |= (1 << (chdat->epnum + 15));
  504. musb_writel(tbase, TUSB_DMA_INT_MASK, reg);
  505. reg = musb_readl(tbase, TUSB_DMA_INT_CLEAR);
  506. if (chdat->tx)
  507. reg |= (1 << chdat->epnum);
  508. else
  509. reg |= (1 << (chdat->epnum + 15));
  510. musb_writel(tbase, TUSB_DMA_INT_CLEAR, reg);
  511. channel->status = MUSB_DMA_STATUS_UNKNOWN;
  512. if (chdat->ch >= 0) {
  513. omap_stop_dma(chdat->ch);
  514. omap_free_dma(chdat->ch);
  515. chdat->ch = -1;
  516. }
  517. if (chdat->dmareq >= 0)
  518. tusb_omap_dma_free_dmareq(chdat);
  519. channel = NULL;
  520. }
  521. void dma_controller_destroy(struct dma_controller *c)
  522. {
  523. struct tusb_omap_dma *tusb_dma;
  524. int i;
  525. tusb_dma = container_of(c, struct tusb_omap_dma, controller);
  526. for (i = 0; i < MAX_DMAREQ; i++) {
  527. struct dma_channel *ch = dma_channel_pool[i];
  528. if (ch) {
  529. kfree(ch->private_data);
  530. kfree(ch);
  531. }
  532. }
  533. if (!tusb_dma->multichannel && tusb_dma && tusb_dma->ch >= 0)
  534. omap_free_dma(tusb_dma->ch);
  535. kfree(tusb_dma);
  536. }
  537. struct dma_controller *__init
  538. dma_controller_create(struct musb *musb, void __iomem *base)
  539. {
  540. void __iomem *tbase = musb->ctrl_base;
  541. struct tusb_omap_dma *tusb_dma;
  542. int i;
  543. /* REVISIT: Get dmareq lines used from board-*.c */
  544. musb_writel(musb->ctrl_base, TUSB_DMA_INT_MASK, 0x7fffffff);
  545. musb_writel(musb->ctrl_base, TUSB_DMA_EP_MAP, 0);
  546. musb_writel(tbase, TUSB_DMA_REQ_CONF,
  547. TUSB_DMA_REQ_CONF_BURST_SIZE(2)
  548. | TUSB_DMA_REQ_CONF_DMA_REQ_EN(0x3f)
  549. | TUSB_DMA_REQ_CONF_DMA_REQ_ASSER(2));
  550. tusb_dma = kzalloc(sizeof(struct tusb_omap_dma), GFP_KERNEL);
  551. if (!tusb_dma)
  552. goto cleanup;
  553. tusb_dma->musb = musb;
  554. tusb_dma->tbase = musb->ctrl_base;
  555. tusb_dma->ch = -1;
  556. tusb_dma->dmareq = -1;
  557. tusb_dma->sync_dev = -1;
  558. tusb_dma->controller.start = tusb_omap_dma_start;
  559. tusb_dma->controller.stop = tusb_omap_dma_stop;
  560. tusb_dma->controller.channel_alloc = tusb_omap_dma_allocate;
  561. tusb_dma->controller.channel_release = tusb_omap_dma_release;
  562. tusb_dma->controller.channel_program = tusb_omap_dma_program;
  563. tusb_dma->controller.channel_abort = tusb_omap_dma_abort;
  564. if (tusb_get_revision(musb) >= TUSB_REV_30)
  565. tusb_dma->multichannel = 1;
  566. for (i = 0; i < MAX_DMAREQ; i++) {
  567. struct dma_channel *ch;
  568. struct tusb_omap_dma_ch *chdat;
  569. ch = kzalloc(sizeof(struct dma_channel), GFP_KERNEL);
  570. if (!ch)
  571. goto cleanup;
  572. dma_channel_pool[i] = ch;
  573. chdat = kzalloc(sizeof(struct tusb_omap_dma_ch), GFP_KERNEL);
  574. if (!chdat)
  575. goto cleanup;
  576. ch->status = MUSB_DMA_STATUS_UNKNOWN;
  577. ch->private_data = chdat;
  578. }
  579. return &tusb_dma->controller;
  580. cleanup:
  581. dma_controller_destroy(&tusb_dma->controller);
  582. return NULL;
  583. }