musb_cppi41.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733
  1. #include <linux/device.h>
  2. #include <linux/dma-mapping.h>
  3. #include <linux/dmaengine.h>
  4. #include <linux/sizes.h>
  5. #include <linux/platform_device.h>
  6. #include <linux/of.h>
  7. #include "musb_core.h"
  8. #define RNDIS_REG(x) (0x80 + ((x - 1) * 4))
  9. #define EP_MODE_AUTOREQ_NONE 0
  10. #define EP_MODE_AUTOREQ_ALL_NEOP 1
  11. #define EP_MODE_AUTOREQ_ALWAYS 3
  12. #define EP_MODE_DMA_TRANSPARENT 0
  13. #define EP_MODE_DMA_RNDIS 1
  14. #define EP_MODE_DMA_GEN_RNDIS 3
  15. #define USB_CTRL_TX_MODE 0x70
  16. #define USB_CTRL_RX_MODE 0x74
  17. #define USB_CTRL_AUTOREQ 0xd0
  18. #define USB_TDOWN 0xd8
  19. struct cppi41_dma_channel {
  20. struct dma_channel channel;
  21. struct cppi41_dma_controller *controller;
  22. struct musb_hw_ep *hw_ep;
  23. struct dma_chan *dc;
  24. dma_cookie_t cookie;
  25. u8 port_num;
  26. u8 is_tx;
  27. u8 is_allocated;
  28. u8 usb_toggle;
  29. dma_addr_t buf_addr;
  30. u32 total_len;
  31. u32 prog_len;
  32. u32 transferred;
  33. u32 packet_sz;
  34. struct list_head tx_check;
  35. int tx_zlp;
  36. };
  37. #define MUSB_DMA_NUM_CHANNELS 15
  38. struct cppi41_dma_controller {
  39. struct dma_controller controller;
  40. struct cppi41_dma_channel rx_channel[MUSB_DMA_NUM_CHANNELS];
  41. struct cppi41_dma_channel tx_channel[MUSB_DMA_NUM_CHANNELS];
  42. struct musb *musb;
  43. struct hrtimer early_tx;
  44. struct list_head early_tx_list;
  45. u32 rx_mode;
  46. u32 tx_mode;
  47. u32 auto_req;
  48. };
  49. static void save_rx_toggle(struct cppi41_dma_channel *cppi41_channel)
  50. {
  51. u16 csr;
  52. u8 toggle;
  53. if (cppi41_channel->is_tx)
  54. return;
  55. if (!is_host_active(cppi41_channel->controller->musb))
  56. return;
  57. csr = musb_readw(cppi41_channel->hw_ep->regs, MUSB_RXCSR);
  58. toggle = csr & MUSB_RXCSR_H_DATATOGGLE ? 1 : 0;
  59. cppi41_channel->usb_toggle = toggle;
  60. }
  61. static void update_rx_toggle(struct cppi41_dma_channel *cppi41_channel)
  62. {
  63. struct musb_hw_ep *hw_ep = cppi41_channel->hw_ep;
  64. struct musb *musb = hw_ep->musb;
  65. u16 csr;
  66. u8 toggle;
  67. if (cppi41_channel->is_tx)
  68. return;
  69. if (!is_host_active(musb))
  70. return;
  71. musb_ep_select(musb->mregs, hw_ep->epnum);
  72. csr = musb_readw(hw_ep->regs, MUSB_RXCSR);
  73. toggle = csr & MUSB_RXCSR_H_DATATOGGLE ? 1 : 0;
  74. /*
  75. * AM335x Advisory 1.0.13: Due to internal synchronisation error the
  76. * data toggle may reset from DATA1 to DATA0 during receiving data from
  77. * more than one endpoint.
  78. */
  79. if (!toggle && toggle == cppi41_channel->usb_toggle) {
  80. csr |= MUSB_RXCSR_H_DATATOGGLE | MUSB_RXCSR_H_WR_DATATOGGLE;
  81. musb_writew(cppi41_channel->hw_ep->regs, MUSB_RXCSR, csr);
  82. dev_dbg(cppi41_channel->controller->musb->controller,
  83. "Restoring DATA1 toggle.\n");
  84. }
  85. cppi41_channel->usb_toggle = toggle;
  86. }
  87. static bool musb_is_tx_fifo_empty(struct musb_hw_ep *hw_ep)
  88. {
  89. u8 epnum = hw_ep->epnum;
  90. struct musb *musb = hw_ep->musb;
  91. void __iomem *epio = musb->endpoints[epnum].regs;
  92. u16 csr;
  93. musb_ep_select(musb->mregs, hw_ep->epnum);
  94. csr = musb_readw(epio, MUSB_TXCSR);
  95. if (csr & MUSB_TXCSR_TXPKTRDY)
  96. return false;
  97. return true;
  98. }
  99. static void cppi41_dma_callback(void *private_data);
  100. static void cppi41_trans_done(struct cppi41_dma_channel *cppi41_channel)
  101. {
  102. struct musb_hw_ep *hw_ep = cppi41_channel->hw_ep;
  103. struct musb *musb = hw_ep->musb;
  104. void __iomem *epio = hw_ep->regs;
  105. u16 csr;
  106. if (!cppi41_channel->prog_len ||
  107. (cppi41_channel->channel.status == MUSB_DMA_STATUS_FREE)) {
  108. /* done, complete */
  109. cppi41_channel->channel.actual_len =
  110. cppi41_channel->transferred;
  111. cppi41_channel->channel.status = MUSB_DMA_STATUS_FREE;
  112. cppi41_channel->channel.rx_packet_done = true;
  113. /*
  114. * transmit ZLP using PIO mode for transfers which size is
  115. * multiple of EP packet size.
  116. */
  117. if (cppi41_channel->tx_zlp && (cppi41_channel->transferred %
  118. cppi41_channel->packet_sz) == 0) {
  119. musb_ep_select(musb->mregs, hw_ep->epnum);
  120. csr = MUSB_TXCSR_MODE | MUSB_TXCSR_TXPKTRDY;
  121. musb_writew(epio, MUSB_TXCSR, csr);
  122. }
  123. musb_dma_completion(musb, hw_ep->epnum, cppi41_channel->is_tx);
  124. } else {
  125. /* next iteration, reload */
  126. struct dma_chan *dc = cppi41_channel->dc;
  127. struct dma_async_tx_descriptor *dma_desc;
  128. enum dma_transfer_direction direction;
  129. u32 remain_bytes;
  130. cppi41_channel->buf_addr += cppi41_channel->packet_sz;
  131. remain_bytes = cppi41_channel->total_len;
  132. remain_bytes -= cppi41_channel->transferred;
  133. remain_bytes = min(remain_bytes, cppi41_channel->packet_sz);
  134. cppi41_channel->prog_len = remain_bytes;
  135. direction = cppi41_channel->is_tx ? DMA_MEM_TO_DEV
  136. : DMA_DEV_TO_MEM;
  137. dma_desc = dmaengine_prep_slave_single(dc,
  138. cppi41_channel->buf_addr,
  139. remain_bytes,
  140. direction,
  141. DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
  142. if (WARN_ON(!dma_desc))
  143. return;
  144. dma_desc->callback = cppi41_dma_callback;
  145. dma_desc->callback_param = &cppi41_channel->channel;
  146. cppi41_channel->cookie = dma_desc->tx_submit(dma_desc);
  147. dma_async_issue_pending(dc);
  148. if (!cppi41_channel->is_tx) {
  149. musb_ep_select(musb->mregs, hw_ep->epnum);
  150. csr = musb_readw(epio, MUSB_RXCSR);
  151. csr |= MUSB_RXCSR_H_REQPKT;
  152. musb_writew(epio, MUSB_RXCSR, csr);
  153. }
  154. }
  155. }
  156. static enum hrtimer_restart cppi41_recheck_tx_req(struct hrtimer *timer)
  157. {
  158. struct cppi41_dma_controller *controller;
  159. struct cppi41_dma_channel *cppi41_channel, *n;
  160. struct musb *musb;
  161. unsigned long flags;
  162. enum hrtimer_restart ret = HRTIMER_NORESTART;
  163. controller = container_of(timer, struct cppi41_dma_controller,
  164. early_tx);
  165. musb = controller->musb;
  166. spin_lock_irqsave(&musb->lock, flags);
  167. list_for_each_entry_safe(cppi41_channel, n, &controller->early_tx_list,
  168. tx_check) {
  169. bool empty;
  170. struct musb_hw_ep *hw_ep = cppi41_channel->hw_ep;
  171. empty = musb_is_tx_fifo_empty(hw_ep);
  172. if (empty) {
  173. list_del_init(&cppi41_channel->tx_check);
  174. cppi41_trans_done(cppi41_channel);
  175. }
  176. }
  177. if (!list_empty(&controller->early_tx_list) &&
  178. !hrtimer_is_queued(&controller->early_tx)) {
  179. ret = HRTIMER_RESTART;
  180. hrtimer_forward_now(&controller->early_tx,
  181. ktime_set(0, 20 * NSEC_PER_USEC));
  182. }
  183. spin_unlock_irqrestore(&musb->lock, flags);
  184. return ret;
  185. }
  186. static void cppi41_dma_callback(void *private_data)
  187. {
  188. struct dma_channel *channel = private_data;
  189. struct cppi41_dma_channel *cppi41_channel = channel->private_data;
  190. struct musb_hw_ep *hw_ep = cppi41_channel->hw_ep;
  191. struct cppi41_dma_controller *controller;
  192. struct musb *musb = hw_ep->musb;
  193. unsigned long flags;
  194. struct dma_tx_state txstate;
  195. u32 transferred;
  196. int is_hs = 0;
  197. bool empty;
  198. spin_lock_irqsave(&musb->lock, flags);
  199. dmaengine_tx_status(cppi41_channel->dc, cppi41_channel->cookie,
  200. &txstate);
  201. transferred = cppi41_channel->prog_len - txstate.residue;
  202. cppi41_channel->transferred += transferred;
  203. dev_dbg(musb->controller, "DMA transfer done on hw_ep=%d bytes=%d/%d\n",
  204. hw_ep->epnum, cppi41_channel->transferred,
  205. cppi41_channel->total_len);
  206. update_rx_toggle(cppi41_channel);
  207. if (cppi41_channel->transferred == cppi41_channel->total_len ||
  208. transferred < cppi41_channel->packet_sz)
  209. cppi41_channel->prog_len = 0;
  210. if (cppi41_channel->is_tx)
  211. empty = musb_is_tx_fifo_empty(hw_ep);
  212. if (!cppi41_channel->is_tx || empty) {
  213. cppi41_trans_done(cppi41_channel);
  214. goto out;
  215. }
  216. /*
  217. * On AM335x it has been observed that the TX interrupt fires
  218. * too early that means the TXFIFO is not yet empty but the DMA
  219. * engine says that it is done with the transfer. We don't
  220. * receive a FIFO empty interrupt so the only thing we can do is
  221. * to poll for the bit. On HS it usually takes 2us, on FS around
  222. * 110us - 150us depending on the transfer size.
  223. * We spin on HS (no longer than than 25us and setup a timer on
  224. * FS to check for the bit and complete the transfer.
  225. */
  226. controller = cppi41_channel->controller;
  227. if (is_host_active(musb)) {
  228. if (musb->port1_status & USB_PORT_STAT_HIGH_SPEED)
  229. is_hs = 1;
  230. } else {
  231. if (musb->g.speed == USB_SPEED_HIGH)
  232. is_hs = 1;
  233. }
  234. if (is_hs) {
  235. unsigned wait = 25;
  236. do {
  237. empty = musb_is_tx_fifo_empty(hw_ep);
  238. if (empty) {
  239. cppi41_trans_done(cppi41_channel);
  240. goto out;
  241. }
  242. wait--;
  243. if (!wait)
  244. break;
  245. cpu_relax();
  246. } while (1);
  247. }
  248. list_add_tail(&cppi41_channel->tx_check,
  249. &controller->early_tx_list);
  250. if (!hrtimer_is_queued(&controller->early_tx)) {
  251. unsigned long usecs = cppi41_channel->total_len / 10;
  252. hrtimer_start_range_ns(&controller->early_tx,
  253. ktime_set(0, usecs * NSEC_PER_USEC),
  254. 20 * NSEC_PER_USEC,
  255. HRTIMER_MODE_REL);
  256. }
  257. out:
  258. spin_unlock_irqrestore(&musb->lock, flags);
  259. }
  260. static u32 update_ep_mode(unsigned ep, unsigned mode, u32 old)
  261. {
  262. unsigned shift;
  263. shift = (ep - 1) * 2;
  264. old &= ~(3 << shift);
  265. old |= mode << shift;
  266. return old;
  267. }
  268. static void cppi41_set_dma_mode(struct cppi41_dma_channel *cppi41_channel,
  269. unsigned mode)
  270. {
  271. struct cppi41_dma_controller *controller = cppi41_channel->controller;
  272. u32 port;
  273. u32 new_mode;
  274. u32 old_mode;
  275. if (cppi41_channel->is_tx)
  276. old_mode = controller->tx_mode;
  277. else
  278. old_mode = controller->rx_mode;
  279. port = cppi41_channel->port_num;
  280. new_mode = update_ep_mode(port, mode, old_mode);
  281. if (new_mode == old_mode)
  282. return;
  283. if (cppi41_channel->is_tx) {
  284. controller->tx_mode = new_mode;
  285. musb_writel(controller->musb->ctrl_base, USB_CTRL_TX_MODE,
  286. new_mode);
  287. } else {
  288. controller->rx_mode = new_mode;
  289. musb_writel(controller->musb->ctrl_base, USB_CTRL_RX_MODE,
  290. new_mode);
  291. }
  292. }
  293. static void cppi41_set_autoreq_mode(struct cppi41_dma_channel *cppi41_channel,
  294. unsigned mode)
  295. {
  296. struct cppi41_dma_controller *controller = cppi41_channel->controller;
  297. u32 port;
  298. u32 new_mode;
  299. u32 old_mode;
  300. old_mode = controller->auto_req;
  301. port = cppi41_channel->port_num;
  302. new_mode = update_ep_mode(port, mode, old_mode);
  303. if (new_mode == old_mode)
  304. return;
  305. controller->auto_req = new_mode;
  306. musb_writel(controller->musb->ctrl_base, USB_CTRL_AUTOREQ, new_mode);
  307. }
  308. static bool cppi41_configure_channel(struct dma_channel *channel,
  309. u16 packet_sz, u8 mode,
  310. dma_addr_t dma_addr, u32 len)
  311. {
  312. struct cppi41_dma_channel *cppi41_channel = channel->private_data;
  313. struct dma_chan *dc = cppi41_channel->dc;
  314. struct dma_async_tx_descriptor *dma_desc;
  315. enum dma_transfer_direction direction;
  316. struct musb *musb = cppi41_channel->controller->musb;
  317. unsigned use_gen_rndis = 0;
  318. dev_dbg(musb->controller,
  319. "configure ep%d/%x packet_sz=%d, mode=%d, dma_addr=0x%llx, len=%d is_tx=%d\n",
  320. cppi41_channel->port_num, RNDIS_REG(cppi41_channel->port_num),
  321. packet_sz, mode, (unsigned long long) dma_addr,
  322. len, cppi41_channel->is_tx);
  323. cppi41_channel->buf_addr = dma_addr;
  324. cppi41_channel->total_len = len;
  325. cppi41_channel->transferred = 0;
  326. cppi41_channel->packet_sz = packet_sz;
  327. cppi41_channel->tx_zlp = (cppi41_channel->is_tx && mode) ? 1 : 0;
  328. /*
  329. * Due to AM335x' Advisory 1.0.13 we are not allowed to transfer more
  330. * than max packet size at a time.
  331. */
  332. if (cppi41_channel->is_tx)
  333. use_gen_rndis = 1;
  334. if (use_gen_rndis) {
  335. /* RNDIS mode */
  336. if (len > packet_sz) {
  337. musb_writel(musb->ctrl_base,
  338. RNDIS_REG(cppi41_channel->port_num), len);
  339. /* gen rndis */
  340. cppi41_set_dma_mode(cppi41_channel,
  341. EP_MODE_DMA_GEN_RNDIS);
  342. /* auto req */
  343. cppi41_set_autoreq_mode(cppi41_channel,
  344. EP_MODE_AUTOREQ_ALL_NEOP);
  345. } else {
  346. musb_writel(musb->ctrl_base,
  347. RNDIS_REG(cppi41_channel->port_num), 0);
  348. cppi41_set_dma_mode(cppi41_channel,
  349. EP_MODE_DMA_TRANSPARENT);
  350. cppi41_set_autoreq_mode(cppi41_channel,
  351. EP_MODE_AUTOREQ_NONE);
  352. }
  353. } else {
  354. /* fallback mode */
  355. cppi41_set_dma_mode(cppi41_channel, EP_MODE_DMA_TRANSPARENT);
  356. cppi41_set_autoreq_mode(cppi41_channel, EP_MODE_AUTOREQ_NONE);
  357. len = min_t(u32, packet_sz, len);
  358. }
  359. cppi41_channel->prog_len = len;
  360. direction = cppi41_channel->is_tx ? DMA_MEM_TO_DEV : DMA_DEV_TO_MEM;
  361. dma_desc = dmaengine_prep_slave_single(dc, dma_addr, len, direction,
  362. DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
  363. if (!dma_desc)
  364. return false;
  365. dma_desc->callback = cppi41_dma_callback;
  366. dma_desc->callback_param = channel;
  367. cppi41_channel->cookie = dma_desc->tx_submit(dma_desc);
  368. cppi41_channel->channel.rx_packet_done = false;
  369. save_rx_toggle(cppi41_channel);
  370. dma_async_issue_pending(dc);
  371. return true;
  372. }
  373. static struct dma_channel *cppi41_dma_channel_allocate(struct dma_controller *c,
  374. struct musb_hw_ep *hw_ep, u8 is_tx)
  375. {
  376. struct cppi41_dma_controller *controller = container_of(c,
  377. struct cppi41_dma_controller, controller);
  378. struct cppi41_dma_channel *cppi41_channel = NULL;
  379. u8 ch_num = hw_ep->epnum - 1;
  380. if (ch_num >= MUSB_DMA_NUM_CHANNELS)
  381. return NULL;
  382. if (is_tx)
  383. cppi41_channel = &controller->tx_channel[ch_num];
  384. else
  385. cppi41_channel = &controller->rx_channel[ch_num];
  386. if (!cppi41_channel->dc)
  387. return NULL;
  388. if (cppi41_channel->is_allocated)
  389. return NULL;
  390. cppi41_channel->hw_ep = hw_ep;
  391. cppi41_channel->is_allocated = 1;
  392. return &cppi41_channel->channel;
  393. }
  394. static void cppi41_dma_channel_release(struct dma_channel *channel)
  395. {
  396. struct cppi41_dma_channel *cppi41_channel = channel->private_data;
  397. if (cppi41_channel->is_allocated) {
  398. cppi41_channel->is_allocated = 0;
  399. channel->status = MUSB_DMA_STATUS_FREE;
  400. channel->actual_len = 0;
  401. }
  402. }
  403. static int cppi41_dma_channel_program(struct dma_channel *channel,
  404. u16 packet_sz, u8 mode,
  405. dma_addr_t dma_addr, u32 len)
  406. {
  407. int ret;
  408. struct cppi41_dma_channel *cppi41_channel = channel->private_data;
  409. int hb_mult = 0;
  410. BUG_ON(channel->status == MUSB_DMA_STATUS_UNKNOWN ||
  411. channel->status == MUSB_DMA_STATUS_BUSY);
  412. if (is_host_active(cppi41_channel->controller->musb)) {
  413. if (cppi41_channel->is_tx)
  414. hb_mult = cppi41_channel->hw_ep->out_qh->hb_mult;
  415. else
  416. hb_mult = cppi41_channel->hw_ep->in_qh->hb_mult;
  417. }
  418. channel->status = MUSB_DMA_STATUS_BUSY;
  419. channel->actual_len = 0;
  420. if (hb_mult)
  421. packet_sz = hb_mult * (packet_sz & 0x7FF);
  422. ret = cppi41_configure_channel(channel, packet_sz, mode, dma_addr, len);
  423. if (!ret)
  424. channel->status = MUSB_DMA_STATUS_FREE;
  425. return ret;
  426. }
  427. static int cppi41_is_compatible(struct dma_channel *channel, u16 maxpacket,
  428. void *buf, u32 length)
  429. {
  430. struct cppi41_dma_channel *cppi41_channel = channel->private_data;
  431. struct cppi41_dma_controller *controller = cppi41_channel->controller;
  432. struct musb *musb = controller->musb;
  433. if (is_host_active(musb)) {
  434. WARN_ON(1);
  435. return 1;
  436. }
  437. if (cppi41_channel->hw_ep->ep_in.type != USB_ENDPOINT_XFER_BULK)
  438. return 0;
  439. if (cppi41_channel->is_tx)
  440. return 1;
  441. /* AM335x Advisory 1.0.13. No workaround for device RX mode */
  442. return 0;
  443. }
  444. static int cppi41_dma_channel_abort(struct dma_channel *channel)
  445. {
  446. struct cppi41_dma_channel *cppi41_channel = channel->private_data;
  447. struct cppi41_dma_controller *controller = cppi41_channel->controller;
  448. struct musb *musb = controller->musb;
  449. void __iomem *epio = cppi41_channel->hw_ep->regs;
  450. int tdbit;
  451. int ret;
  452. unsigned is_tx;
  453. u16 csr;
  454. is_tx = cppi41_channel->is_tx;
  455. dev_dbg(musb->controller, "abort channel=%d, is_tx=%d\n",
  456. cppi41_channel->port_num, is_tx);
  457. if (cppi41_channel->channel.status == MUSB_DMA_STATUS_FREE)
  458. return 0;
  459. list_del_init(&cppi41_channel->tx_check);
  460. if (is_tx) {
  461. csr = musb_readw(epio, MUSB_TXCSR);
  462. csr &= ~MUSB_TXCSR_DMAENAB;
  463. musb_writew(epio, MUSB_TXCSR, csr);
  464. } else {
  465. cppi41_set_autoreq_mode(cppi41_channel, EP_MODE_AUTOREQ_NONE);
  466. /* delay to drain to cppi dma pipeline for isoch */
  467. udelay(250);
  468. csr = musb_readw(epio, MUSB_RXCSR);
  469. csr &= ~(MUSB_RXCSR_H_REQPKT | MUSB_RXCSR_DMAENAB);
  470. musb_writew(epio, MUSB_RXCSR, csr);
  471. /* wait to drain cppi dma pipe line */
  472. udelay(50);
  473. csr = musb_readw(epio, MUSB_RXCSR);
  474. if (csr & MUSB_RXCSR_RXPKTRDY) {
  475. csr |= MUSB_RXCSR_FLUSHFIFO;
  476. musb_writew(epio, MUSB_RXCSR, csr);
  477. musb_writew(epio, MUSB_RXCSR, csr);
  478. }
  479. }
  480. tdbit = 1 << cppi41_channel->port_num;
  481. if (is_tx)
  482. tdbit <<= 16;
  483. do {
  484. if (is_tx)
  485. musb_writel(musb->ctrl_base, USB_TDOWN, tdbit);
  486. ret = dmaengine_terminate_all(cppi41_channel->dc);
  487. } while (ret == -EAGAIN);
  488. if (is_tx) {
  489. musb_writel(musb->ctrl_base, USB_TDOWN, tdbit);
  490. csr = musb_readw(epio, MUSB_TXCSR);
  491. if (csr & MUSB_TXCSR_TXPKTRDY) {
  492. csr |= MUSB_TXCSR_FLUSHFIFO;
  493. musb_writew(epio, MUSB_TXCSR, csr);
  494. }
  495. }
  496. cppi41_channel->channel.status = MUSB_DMA_STATUS_FREE;
  497. return 0;
  498. }
  499. static void cppi41_release_all_dma_chans(struct cppi41_dma_controller *ctrl)
  500. {
  501. struct dma_chan *dc;
  502. int i;
  503. for (i = 0; i < MUSB_DMA_NUM_CHANNELS; i++) {
  504. dc = ctrl->tx_channel[i].dc;
  505. if (dc)
  506. dma_release_channel(dc);
  507. dc = ctrl->rx_channel[i].dc;
  508. if (dc)
  509. dma_release_channel(dc);
  510. }
  511. }
  512. static void cppi41_dma_controller_stop(struct cppi41_dma_controller *controller)
  513. {
  514. cppi41_release_all_dma_chans(controller);
  515. }
  516. static int cppi41_dma_controller_start(struct cppi41_dma_controller *controller)
  517. {
  518. struct musb *musb = controller->musb;
  519. struct device *dev = musb->controller;
  520. struct device_node *np = dev->parent->of_node;
  521. struct cppi41_dma_channel *cppi41_channel;
  522. int count;
  523. int i;
  524. int ret;
  525. count = of_property_count_strings(np, "dma-names");
  526. if (count < 0)
  527. return count;
  528. for (i = 0; i < count; i++) {
  529. struct dma_chan *dc;
  530. struct dma_channel *musb_dma;
  531. const char *str;
  532. unsigned is_tx;
  533. unsigned int port;
  534. ret = of_property_read_string_index(np, "dma-names", i, &str);
  535. if (ret)
  536. goto err;
  537. if (strstarts(str, "tx"))
  538. is_tx = 1;
  539. else if (strstarts(str, "rx"))
  540. is_tx = 0;
  541. else {
  542. dev_err(dev, "Wrong dmatype %s\n", str);
  543. goto err;
  544. }
  545. ret = kstrtouint(str + 2, 0, &port);
  546. if (ret)
  547. goto err;
  548. ret = -EINVAL;
  549. if (port > MUSB_DMA_NUM_CHANNELS || !port)
  550. goto err;
  551. if (is_tx)
  552. cppi41_channel = &controller->tx_channel[port - 1];
  553. else
  554. cppi41_channel = &controller->rx_channel[port - 1];
  555. cppi41_channel->controller = controller;
  556. cppi41_channel->port_num = port;
  557. cppi41_channel->is_tx = is_tx;
  558. INIT_LIST_HEAD(&cppi41_channel->tx_check);
  559. musb_dma = &cppi41_channel->channel;
  560. musb_dma->private_data = cppi41_channel;
  561. musb_dma->status = MUSB_DMA_STATUS_FREE;
  562. musb_dma->max_len = SZ_4M;
  563. dc = dma_request_slave_channel(dev->parent, str);
  564. if (!dc) {
  565. dev_err(dev, "Failed to request %s.\n", str);
  566. ret = -EPROBE_DEFER;
  567. goto err;
  568. }
  569. cppi41_channel->dc = dc;
  570. }
  571. return 0;
  572. err:
  573. cppi41_release_all_dma_chans(controller);
  574. return ret;
  575. }
  576. void cppi41_dma_controller_destroy(struct dma_controller *c)
  577. {
  578. struct cppi41_dma_controller *controller = container_of(c,
  579. struct cppi41_dma_controller, controller);
  580. hrtimer_cancel(&controller->early_tx);
  581. cppi41_dma_controller_stop(controller);
  582. kfree(controller);
  583. }
  584. EXPORT_SYMBOL_GPL(cppi41_dma_controller_destroy);
  585. struct dma_controller *
  586. cppi41_dma_controller_create(struct musb *musb, void __iomem *base)
  587. {
  588. struct cppi41_dma_controller *controller;
  589. int ret = 0;
  590. if (!musb->controller->parent->of_node) {
  591. dev_err(musb->controller, "Need DT for the DMA engine.\n");
  592. return NULL;
  593. }
  594. controller = kzalloc(sizeof(*controller), GFP_KERNEL);
  595. if (!controller)
  596. goto kzalloc_fail;
  597. hrtimer_init(&controller->early_tx, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
  598. controller->early_tx.function = cppi41_recheck_tx_req;
  599. INIT_LIST_HEAD(&controller->early_tx_list);
  600. controller->musb = musb;
  601. controller->controller.channel_alloc = cppi41_dma_channel_allocate;
  602. controller->controller.channel_release = cppi41_dma_channel_release;
  603. controller->controller.channel_program = cppi41_dma_channel_program;
  604. controller->controller.channel_abort = cppi41_dma_channel_abort;
  605. controller->controller.is_compatible = cppi41_is_compatible;
  606. ret = cppi41_dma_controller_start(controller);
  607. if (ret)
  608. goto plat_get_fail;
  609. return &controller->controller;
  610. plat_get_fail:
  611. kfree(controller);
  612. kzalloc_fail:
  613. if (ret == -EPROBE_DEFER)
  614. return ERR_PTR(ret);
  615. return NULL;
  616. }
  617. EXPORT_SYMBOL_GPL(cppi41_dma_controller_create);