fsl-edma-main.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * drivers/dma/fsl-edma.c
  4. *
  5. * Copyright 2013-2014 Freescale Semiconductor, Inc.
  6. *
  7. * Driver for the Freescale eDMA engine with flexible channel multiplexing
  8. * capability for DMA request sources. The eDMA block can be found on some
  9. * Vybrid and Layerscape SoCs.
  10. */
  11. #include <dt-bindings/dma/fsl-edma.h>
  12. #include <linux/bitfield.h>
  13. #include <linux/module.h>
  14. #include <linux/interrupt.h>
  15. #include <linux/clk.h>
  16. #include <linux/of.h>
  17. #include <linux/of_dma.h>
  18. #include <linux/dma-mapping.h>
  19. #include <linux/pm_runtime.h>
  20. #include <linux/pm_domain.h>
  21. #include <linux/property.h>
  22. #include "fsl-edma-common.h"
  23. static void fsl_edma_synchronize(struct dma_chan *chan)
  24. {
  25. struct fsl_edma_chan *fsl_chan = to_fsl_edma_chan(chan);
  26. vchan_synchronize(&fsl_chan->vchan);
  27. }
  28. static irqreturn_t fsl_edma_tx_handler(int irq, void *dev_id)
  29. {
  30. struct fsl_edma_engine *fsl_edma = dev_id;
  31. unsigned int intr, ch;
  32. struct edma_regs *regs = &fsl_edma->regs;
  33. intr = edma_readl(fsl_edma, regs->intl);
  34. if (!intr)
  35. return IRQ_NONE;
  36. for (ch = 0; ch < fsl_edma->n_chans; ch++) {
  37. if (intr & (0x1 << ch)) {
  38. edma_writeb(fsl_edma, EDMA_CINT_CINT(ch), regs->cint);
  39. fsl_edma_tx_chan_handler(&fsl_edma->chans[ch]);
  40. }
  41. }
  42. return IRQ_HANDLED;
  43. }
  44. static irqreturn_t fsl_edma3_tx_handler(int irq, void *dev_id)
  45. {
  46. struct fsl_edma_chan *fsl_chan = dev_id;
  47. unsigned int intr;
  48. intr = edma_readl_chreg(fsl_chan, ch_int);
  49. if (!intr)
  50. return IRQ_NONE;
  51. edma_writel_chreg(fsl_chan, 1, ch_int);
  52. fsl_edma_tx_chan_handler(fsl_chan);
  53. return IRQ_HANDLED;
  54. }
  55. static irqreturn_t fsl_edma2_tx_handler(int irq, void *devi_id)
  56. {
  57. struct fsl_edma_chan *fsl_chan = devi_id;
  58. return fsl_edma_tx_handler(irq, fsl_chan->edma);
  59. }
  60. static irqreturn_t fsl_edma_err_handler(int irq, void *dev_id)
  61. {
  62. struct fsl_edma_engine *fsl_edma = dev_id;
  63. unsigned int err, ch;
  64. struct edma_regs *regs = &fsl_edma->regs;
  65. err = edma_readl(fsl_edma, regs->errl);
  66. if (!err)
  67. return IRQ_NONE;
  68. for (ch = 0; ch < fsl_edma->n_chans; ch++) {
  69. if (err & (0x1 << ch)) {
  70. fsl_edma_disable_request(&fsl_edma->chans[ch]);
  71. edma_writeb(fsl_edma, EDMA_CERR_CERR(ch), regs->cerr);
  72. fsl_edma_err_chan_handler(&fsl_edma->chans[ch]);
  73. }
  74. }
  75. return IRQ_HANDLED;
  76. }
  77. static irqreturn_t fsl_edma_irq_handler(int irq, void *dev_id)
  78. {
  79. if (fsl_edma_tx_handler(irq, dev_id) == IRQ_HANDLED)
  80. return IRQ_HANDLED;
  81. return fsl_edma_err_handler(irq, dev_id);
  82. }
  83. static bool fsl_edma_srcid_in_use(struct fsl_edma_engine *fsl_edma, u32 srcid)
  84. {
  85. struct fsl_edma_chan *fsl_chan;
  86. int i;
  87. for (i = 0; i < fsl_edma->n_chans; i++) {
  88. fsl_chan = &fsl_edma->chans[i];
  89. if (fsl_chan->srcid && srcid == fsl_chan->srcid) {
  90. dev_err(&fsl_chan->pdev->dev, "The srcid is in use, can't use!");
  91. return true;
  92. }
  93. }
  94. return false;
  95. }
  96. static struct dma_chan *fsl_edma_xlate(struct of_phandle_args *dma_spec,
  97. struct of_dma *ofdma)
  98. {
  99. struct fsl_edma_engine *fsl_edma = ofdma->of_dma_data;
  100. struct dma_chan *chan, *_chan;
  101. struct fsl_edma_chan *fsl_chan;
  102. u32 dmamux_nr = fsl_edma->drvdata->dmamuxs;
  103. unsigned long chans_per_mux = fsl_edma->n_chans / dmamux_nr;
  104. if (dma_spec->args_count != 2)
  105. return NULL;
  106. guard(mutex)(&fsl_edma->fsl_edma_mutex);
  107. list_for_each_entry_safe(chan, _chan, &fsl_edma->dma_dev.channels, device_node) {
  108. if (chan->client_count)
  109. continue;
  110. if (fsl_edma_srcid_in_use(fsl_edma, dma_spec->args[1]))
  111. return NULL;
  112. if ((chan->chan_id / chans_per_mux) == dma_spec->args[0]) {
  113. chan = dma_get_slave_channel(chan);
  114. if (chan) {
  115. chan->device->privatecnt++;
  116. fsl_chan = to_fsl_edma_chan(chan);
  117. fsl_chan->srcid = dma_spec->args[1];
  118. if (!fsl_chan->srcid) {
  119. dev_err(&fsl_chan->pdev->dev, "Invalidate srcid %d\n",
  120. fsl_chan->srcid);
  121. return NULL;
  122. }
  123. fsl_edma_chan_mux(fsl_chan, fsl_chan->srcid,
  124. true);
  125. return chan;
  126. }
  127. }
  128. }
  129. return NULL;
  130. }
  131. static struct dma_chan *fsl_edma3_xlate(struct of_phandle_args *dma_spec,
  132. struct of_dma *ofdma)
  133. {
  134. struct fsl_edma_engine *fsl_edma = ofdma->of_dma_data;
  135. struct dma_chan *chan, *_chan;
  136. struct fsl_edma_chan *fsl_chan;
  137. bool b_chmux;
  138. int i;
  139. if (dma_spec->args_count != 3)
  140. return NULL;
  141. b_chmux = !!(fsl_edma->drvdata->flags & FSL_EDMA_DRV_HAS_CHMUX);
  142. guard(mutex)(&fsl_edma->fsl_edma_mutex);
  143. list_for_each_entry_safe(chan, _chan, &fsl_edma->dma_dev.channels,
  144. device_node) {
  145. if (chan->client_count)
  146. continue;
  147. fsl_chan = to_fsl_edma_chan(chan);
  148. if (fsl_edma_srcid_in_use(fsl_edma, dma_spec->args[0]))
  149. return NULL;
  150. i = fsl_chan - fsl_edma->chans;
  151. fsl_chan->priority = dma_spec->args[1];
  152. fsl_chan->is_rxchan = dma_spec->args[2] & FSL_EDMA_RX;
  153. fsl_chan->is_remote = dma_spec->args[2] & FSL_EDMA_REMOTE;
  154. fsl_chan->is_multi_fifo = dma_spec->args[2] & FSL_EDMA_MULTI_FIFO;
  155. if ((dma_spec->args[2] & FSL_EDMA_EVEN_CH) && (i & 0x1))
  156. continue;
  157. if ((dma_spec->args[2] & FSL_EDMA_ODD_CH) && !(i & 0x1))
  158. continue;
  159. if (!b_chmux && i == dma_spec->args[0]) {
  160. chan = dma_get_slave_channel(chan);
  161. chan->device->privatecnt++;
  162. return chan;
  163. } else if (b_chmux && !fsl_chan->srcid) {
  164. /* if controller support channel mux, choose a free channel */
  165. chan = dma_get_slave_channel(chan);
  166. chan->device->privatecnt++;
  167. fsl_chan->srcid = dma_spec->args[0];
  168. return chan;
  169. }
  170. }
  171. return NULL;
  172. }
  173. static int
  174. fsl_edma_irq_init(struct platform_device *pdev, struct fsl_edma_engine *fsl_edma)
  175. {
  176. int ret;
  177. edma_writel(fsl_edma, ~0, fsl_edma->regs.intl);
  178. fsl_edma->txirq = platform_get_irq_byname(pdev, "edma-tx");
  179. if (fsl_edma->txirq < 0)
  180. return fsl_edma->txirq;
  181. fsl_edma->errirq = platform_get_irq_byname(pdev, "edma-err");
  182. if (fsl_edma->errirq < 0)
  183. return fsl_edma->errirq;
  184. if (fsl_edma->txirq == fsl_edma->errirq) {
  185. ret = devm_request_irq(&pdev->dev, fsl_edma->txirq,
  186. fsl_edma_irq_handler, 0, "eDMA", fsl_edma);
  187. if (ret) {
  188. dev_err(&pdev->dev, "Can't register eDMA IRQ.\n");
  189. return ret;
  190. }
  191. } else {
  192. ret = devm_request_irq(&pdev->dev, fsl_edma->txirq,
  193. fsl_edma_tx_handler, 0, "eDMA tx", fsl_edma);
  194. if (ret) {
  195. dev_err(&pdev->dev, "Can't register eDMA tx IRQ.\n");
  196. return ret;
  197. }
  198. ret = devm_request_irq(&pdev->dev, fsl_edma->errirq,
  199. fsl_edma_err_handler, 0, "eDMA err", fsl_edma);
  200. if (ret) {
  201. dev_err(&pdev->dev, "Can't register eDMA err IRQ.\n");
  202. return ret;
  203. }
  204. }
  205. return 0;
  206. }
  207. static int fsl_edma3_irq_init(struct platform_device *pdev, struct fsl_edma_engine *fsl_edma)
  208. {
  209. int i;
  210. for (i = 0; i < fsl_edma->n_chans; i++) {
  211. struct fsl_edma_chan *fsl_chan = &fsl_edma->chans[i];
  212. if (fsl_edma->chan_masked & BIT(i))
  213. continue;
  214. /* request channel irq */
  215. fsl_chan->txirq = platform_get_irq(pdev, i);
  216. if (fsl_chan->txirq < 0)
  217. return -EINVAL;
  218. fsl_chan->irq_handler = fsl_edma3_tx_handler;
  219. }
  220. return 0;
  221. }
  222. static int
  223. fsl_edma2_irq_init(struct platform_device *pdev,
  224. struct fsl_edma_engine *fsl_edma)
  225. {
  226. int i, ret, irq;
  227. int count;
  228. edma_writel(fsl_edma, ~0, fsl_edma->regs.intl);
  229. count = platform_irq_count(pdev);
  230. dev_dbg(&pdev->dev, "%s Found %d interrupts\r\n", __func__, count);
  231. if (count <= 2) {
  232. dev_err(&pdev->dev, "Interrupts in DTS not correct.\n");
  233. return -EINVAL;
  234. }
  235. /*
  236. * 16 channel independent interrupts + 1 error interrupt on i.mx7ulp.
  237. * 2 channel share one interrupt, for example, ch0/ch16, ch1/ch17...
  238. * For now, just simply request irq without IRQF_SHARED flag, since 16
  239. * channels are enough on i.mx7ulp whose M4 domain own some peripherals.
  240. */
  241. for (i = 0; i < count; i++) {
  242. irq = platform_get_irq(pdev, i);
  243. ret = 0;
  244. if (irq < 0)
  245. return -ENXIO;
  246. /* The last IRQ is for eDMA err */
  247. if (i == count - 1) {
  248. fsl_edma->errirq = irq;
  249. ret = devm_request_irq(&pdev->dev, irq,
  250. fsl_edma_err_handler,
  251. 0, "eDMA2-ERR", fsl_edma);
  252. } else {
  253. fsl_edma->chans[i].txirq = irq;
  254. fsl_edma->chans[i].irq_handler = fsl_edma2_tx_handler;
  255. }
  256. if (ret)
  257. return ret;
  258. }
  259. return 0;
  260. }
  261. static void fsl_edma_irq_exit(
  262. struct platform_device *pdev, struct fsl_edma_engine *fsl_edma)
  263. {
  264. if (fsl_edma->txirq == fsl_edma->errirq) {
  265. if (fsl_edma->txirq >= 0)
  266. devm_free_irq(&pdev->dev, fsl_edma->txirq, fsl_edma);
  267. } else {
  268. if (fsl_edma->txirq >= 0)
  269. devm_free_irq(&pdev->dev, fsl_edma->txirq, fsl_edma);
  270. if (fsl_edma->errirq >= 0)
  271. devm_free_irq(&pdev->dev, fsl_edma->errirq, fsl_edma);
  272. }
  273. }
  274. static void fsl_disable_clocks(struct fsl_edma_engine *fsl_edma, int nr_clocks)
  275. {
  276. int i;
  277. for (i = 0; i < nr_clocks; i++)
  278. clk_disable_unprepare(fsl_edma->muxclk[i]);
  279. }
  280. static struct fsl_edma_drvdata vf610_data = {
  281. .dmamuxs = DMAMUX_NR,
  282. .flags = FSL_EDMA_DRV_WRAP_IO,
  283. .chreg_off = EDMA_TCD,
  284. .chreg_space_sz = sizeof(struct fsl_edma_hw_tcd),
  285. .setup_irq = fsl_edma_irq_init,
  286. };
  287. static struct fsl_edma_drvdata ls1028a_data = {
  288. .dmamuxs = DMAMUX_NR,
  289. .flags = FSL_EDMA_DRV_MUX_SWAP | FSL_EDMA_DRV_WRAP_IO,
  290. .chreg_off = EDMA_TCD,
  291. .chreg_space_sz = sizeof(struct fsl_edma_hw_tcd),
  292. .setup_irq = fsl_edma_irq_init,
  293. };
  294. static struct fsl_edma_drvdata imx7ulp_data = {
  295. .dmamuxs = 1,
  296. .chreg_off = EDMA_TCD,
  297. .chreg_space_sz = sizeof(struct fsl_edma_hw_tcd),
  298. .flags = FSL_EDMA_DRV_HAS_DMACLK | FSL_EDMA_DRV_CONFIG32,
  299. .setup_irq = fsl_edma2_irq_init,
  300. };
  301. static struct fsl_edma_drvdata imx8qm_data = {
  302. .flags = FSL_EDMA_DRV_HAS_PD | FSL_EDMA_DRV_EDMA3 | FSL_EDMA_DRV_MEM_REMOTE,
  303. .chreg_space_sz = 0x10000,
  304. .chreg_off = 0x10000,
  305. .setup_irq = fsl_edma3_irq_init,
  306. };
  307. static struct fsl_edma_drvdata imx8ulp_data = {
  308. .flags = FSL_EDMA_DRV_HAS_CHMUX | FSL_EDMA_DRV_HAS_CHCLK | FSL_EDMA_DRV_HAS_DMACLK |
  309. FSL_EDMA_DRV_EDMA3,
  310. .chreg_space_sz = 0x10000,
  311. .chreg_off = 0x10000,
  312. .mux_off = 0x10000 + offsetof(struct fsl_edma3_ch_reg, ch_mux),
  313. .mux_skip = 0x10000,
  314. .setup_irq = fsl_edma3_irq_init,
  315. };
  316. static struct fsl_edma_drvdata imx93_data3 = {
  317. .flags = FSL_EDMA_DRV_HAS_DMACLK | FSL_EDMA_DRV_EDMA3,
  318. .chreg_space_sz = 0x10000,
  319. .chreg_off = 0x10000,
  320. .setup_irq = fsl_edma3_irq_init,
  321. };
  322. static struct fsl_edma_drvdata imx93_data4 = {
  323. .flags = FSL_EDMA_DRV_HAS_CHMUX | FSL_EDMA_DRV_HAS_DMACLK | FSL_EDMA_DRV_EDMA4,
  324. .chreg_space_sz = 0x8000,
  325. .chreg_off = 0x10000,
  326. .mux_off = 0x10000 + offsetof(struct fsl_edma3_ch_reg, ch_mux),
  327. .mux_skip = 0x8000,
  328. .setup_irq = fsl_edma3_irq_init,
  329. };
  330. static struct fsl_edma_drvdata imx95_data5 = {
  331. .flags = FSL_EDMA_DRV_HAS_CHMUX | FSL_EDMA_DRV_HAS_DMACLK | FSL_EDMA_DRV_EDMA4 |
  332. FSL_EDMA_DRV_TCD64,
  333. .chreg_space_sz = 0x8000,
  334. .chreg_off = 0x10000,
  335. .mux_off = 0x200,
  336. .mux_skip = sizeof(u32),
  337. .setup_irq = fsl_edma3_irq_init,
  338. };
  339. static const struct of_device_id fsl_edma_dt_ids[] = {
  340. { .compatible = "fsl,vf610-edma", .data = &vf610_data},
  341. { .compatible = "fsl,ls1028a-edma", .data = &ls1028a_data},
  342. { .compatible = "fsl,imx7ulp-edma", .data = &imx7ulp_data},
  343. { .compatible = "fsl,imx8qm-edma", .data = &imx8qm_data},
  344. { .compatible = "fsl,imx8ulp-edma", .data = &imx8ulp_data},
  345. { .compatible = "fsl,imx93-edma3", .data = &imx93_data3},
  346. { .compatible = "fsl,imx93-edma4", .data = &imx93_data4},
  347. { .compatible = "fsl,imx95-edma5", .data = &imx95_data5},
  348. { /* sentinel */ }
  349. };
  350. MODULE_DEVICE_TABLE(of, fsl_edma_dt_ids);
  351. static void fsl_edma3_detach_pd(struct fsl_edma_engine *fsl_edma)
  352. {
  353. struct fsl_edma_chan *fsl_chan;
  354. int i;
  355. for (i = 0; i < fsl_edma->n_chans; i++) {
  356. if (fsl_edma->chan_masked & BIT(i))
  357. continue;
  358. fsl_chan = &fsl_edma->chans[i];
  359. if (fsl_chan->pd_dev_link)
  360. device_link_del(fsl_chan->pd_dev_link);
  361. if (fsl_chan->pd_dev) {
  362. dev_pm_domain_detach(fsl_chan->pd_dev, false);
  363. pm_runtime_dont_use_autosuspend(fsl_chan->pd_dev);
  364. pm_runtime_set_suspended(fsl_chan->pd_dev);
  365. }
  366. }
  367. }
  368. static void devm_fsl_edma3_detach_pd(void *data)
  369. {
  370. fsl_edma3_detach_pd(data);
  371. }
  372. static int fsl_edma3_attach_pd(struct platform_device *pdev, struct fsl_edma_engine *fsl_edma)
  373. {
  374. struct fsl_edma_chan *fsl_chan;
  375. struct device *pd_chan;
  376. struct device *dev;
  377. int i;
  378. dev = &pdev->dev;
  379. for (i = 0; i < fsl_edma->n_chans; i++) {
  380. if (fsl_edma->chan_masked & BIT(i))
  381. continue;
  382. fsl_chan = &fsl_edma->chans[i];
  383. pd_chan = dev_pm_domain_attach_by_id(dev, i);
  384. if (IS_ERR_OR_NULL(pd_chan)) {
  385. dev_err(dev, "Failed attach pd %d\n", i);
  386. goto detach;
  387. }
  388. fsl_chan->pd_dev_link = device_link_add(dev, pd_chan, DL_FLAG_STATELESS |
  389. DL_FLAG_PM_RUNTIME |
  390. DL_FLAG_RPM_ACTIVE);
  391. if (!fsl_chan->pd_dev_link) {
  392. dev_err(dev, "Failed to add device_link to %d\n", i);
  393. dev_pm_domain_detach(pd_chan, false);
  394. goto detach;
  395. }
  396. fsl_chan->pd_dev = pd_chan;
  397. pm_runtime_use_autosuspend(fsl_chan->pd_dev);
  398. pm_runtime_set_autosuspend_delay(fsl_chan->pd_dev, 200);
  399. pm_runtime_set_active(fsl_chan->pd_dev);
  400. }
  401. return 0;
  402. detach:
  403. fsl_edma3_detach_pd(fsl_edma);
  404. return -EINVAL;
  405. }
  406. static int fsl_edma_probe(struct platform_device *pdev)
  407. {
  408. struct device_node *np = pdev->dev.of_node;
  409. struct fsl_edma_engine *fsl_edma;
  410. const struct fsl_edma_drvdata *drvdata = NULL;
  411. u32 chan_mask[2] = {0, 0};
  412. char clk_name[36];
  413. struct edma_regs *regs;
  414. int chans;
  415. int ret, i;
  416. drvdata = device_get_match_data(&pdev->dev);
  417. if (!drvdata) {
  418. dev_err(&pdev->dev, "unable to find driver data\n");
  419. return -EINVAL;
  420. }
  421. ret = of_property_read_u32(np, "dma-channels", &chans);
  422. if (ret) {
  423. dev_err(&pdev->dev, "Can't get dma-channels.\n");
  424. return ret;
  425. }
  426. fsl_edma = devm_kzalloc(&pdev->dev, struct_size(fsl_edma, chans, chans),
  427. GFP_KERNEL);
  428. if (!fsl_edma)
  429. return -ENOMEM;
  430. fsl_edma->errirq = -EINVAL;
  431. fsl_edma->txirq = -EINVAL;
  432. fsl_edma->drvdata = drvdata;
  433. fsl_edma->n_chans = chans;
  434. mutex_init(&fsl_edma->fsl_edma_mutex);
  435. fsl_edma->membase = devm_platform_ioremap_resource(pdev, 0);
  436. if (IS_ERR(fsl_edma->membase))
  437. return PTR_ERR(fsl_edma->membase);
  438. if (!(drvdata->flags & FSL_EDMA_DRV_SPLIT_REG)) {
  439. fsl_edma_setup_regs(fsl_edma);
  440. regs = &fsl_edma->regs;
  441. }
  442. if (drvdata->flags & FSL_EDMA_DRV_HAS_DMACLK) {
  443. fsl_edma->dmaclk = devm_clk_get_enabled(&pdev->dev, "dma");
  444. if (IS_ERR(fsl_edma->dmaclk)) {
  445. dev_err(&pdev->dev, "Missing DMA block clock.\n");
  446. return PTR_ERR(fsl_edma->dmaclk);
  447. }
  448. }
  449. ret = of_property_read_variable_u32_array(np, "dma-channel-mask", chan_mask, 1, 2);
  450. if (ret > 0) {
  451. fsl_edma->chan_masked = chan_mask[1];
  452. fsl_edma->chan_masked <<= 32;
  453. fsl_edma->chan_masked |= chan_mask[0];
  454. }
  455. for (i = 0; i < fsl_edma->drvdata->dmamuxs; i++) {
  456. char clkname[32];
  457. /* eDMAv3 mux register move to TCD area if ch_mux exist */
  458. if (drvdata->flags & FSL_EDMA_DRV_SPLIT_REG)
  459. break;
  460. fsl_edma->muxbase[i] = devm_platform_ioremap_resource(pdev,
  461. 1 + i);
  462. if (IS_ERR(fsl_edma->muxbase[i])) {
  463. /* on error: disable all previously enabled clks */
  464. fsl_disable_clocks(fsl_edma, i);
  465. return PTR_ERR(fsl_edma->muxbase[i]);
  466. }
  467. sprintf(clkname, "dmamux%d", i);
  468. fsl_edma->muxclk[i] = devm_clk_get_enabled(&pdev->dev, clkname);
  469. if (IS_ERR(fsl_edma->muxclk[i])) {
  470. dev_err(&pdev->dev, "Missing DMAMUX block clock.\n");
  471. /* on error: disable all previously enabled clks */
  472. return PTR_ERR(fsl_edma->muxclk[i]);
  473. }
  474. }
  475. fsl_edma->big_endian = of_property_read_bool(np, "big-endian");
  476. if (drvdata->flags & FSL_EDMA_DRV_HAS_PD) {
  477. ret = fsl_edma3_attach_pd(pdev, fsl_edma);
  478. if (ret)
  479. return ret;
  480. ret = devm_add_action_or_reset(&pdev->dev, devm_fsl_edma3_detach_pd, fsl_edma);
  481. if (ret)
  482. return ret;
  483. }
  484. if (drvdata->flags & FSL_EDMA_DRV_TCD64)
  485. dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
  486. INIT_LIST_HEAD(&fsl_edma->dma_dev.channels);
  487. for (i = 0; i < fsl_edma->n_chans; i++) {
  488. struct fsl_edma_chan *fsl_chan = &fsl_edma->chans[i];
  489. int len;
  490. if (fsl_edma->chan_masked & BIT(i))
  491. continue;
  492. snprintf(fsl_chan->chan_name, sizeof(fsl_chan->chan_name), "%s-CH%02d",
  493. dev_name(&pdev->dev), i);
  494. fsl_chan->edma = fsl_edma;
  495. fsl_chan->pm_state = RUNNING;
  496. fsl_chan->srcid = 0;
  497. fsl_chan->dma_dir = DMA_NONE;
  498. fsl_chan->vchan.desc_free = fsl_edma_free_desc;
  499. len = (drvdata->flags & FSL_EDMA_DRV_SPLIT_REG) ?
  500. offsetof(struct fsl_edma3_ch_reg, tcd) : 0;
  501. fsl_chan->tcd = fsl_edma->membase
  502. + i * drvdata->chreg_space_sz + drvdata->chreg_off + len;
  503. fsl_chan->mux_addr = fsl_edma->membase + drvdata->mux_off + i * drvdata->mux_skip;
  504. if (drvdata->flags & FSL_EDMA_DRV_HAS_CHCLK) {
  505. snprintf(clk_name, sizeof(clk_name), "ch%02d", i);
  506. fsl_chan->clk = devm_clk_get_enabled(&pdev->dev,
  507. (const char *)clk_name);
  508. if (IS_ERR(fsl_chan->clk))
  509. return PTR_ERR(fsl_chan->clk);
  510. }
  511. fsl_chan->pdev = pdev;
  512. vchan_init(&fsl_chan->vchan, &fsl_edma->dma_dev);
  513. edma_write_tcdreg(fsl_chan, cpu_to_le32(0), csr);
  514. fsl_edma_chan_mux(fsl_chan, 0, false);
  515. if (fsl_chan->edma->drvdata->flags & FSL_EDMA_DRV_HAS_CHCLK)
  516. clk_disable_unprepare(fsl_chan->clk);
  517. }
  518. ret = fsl_edma->drvdata->setup_irq(pdev, fsl_edma);
  519. if (ret)
  520. return ret;
  521. dma_cap_set(DMA_PRIVATE, fsl_edma->dma_dev.cap_mask);
  522. dma_cap_set(DMA_SLAVE, fsl_edma->dma_dev.cap_mask);
  523. dma_cap_set(DMA_CYCLIC, fsl_edma->dma_dev.cap_mask);
  524. dma_cap_set(DMA_MEMCPY, fsl_edma->dma_dev.cap_mask);
  525. fsl_edma->dma_dev.dev = &pdev->dev;
  526. fsl_edma->dma_dev.device_alloc_chan_resources
  527. = fsl_edma_alloc_chan_resources;
  528. fsl_edma->dma_dev.device_free_chan_resources
  529. = fsl_edma_free_chan_resources;
  530. fsl_edma->dma_dev.device_tx_status = fsl_edma_tx_status;
  531. fsl_edma->dma_dev.device_prep_slave_sg = fsl_edma_prep_slave_sg;
  532. fsl_edma->dma_dev.device_prep_dma_cyclic = fsl_edma_prep_dma_cyclic;
  533. fsl_edma->dma_dev.device_prep_dma_memcpy = fsl_edma_prep_memcpy;
  534. fsl_edma->dma_dev.device_config = fsl_edma_slave_config;
  535. fsl_edma->dma_dev.device_pause = fsl_edma_pause;
  536. fsl_edma->dma_dev.device_resume = fsl_edma_resume;
  537. fsl_edma->dma_dev.device_terminate_all = fsl_edma_terminate_all;
  538. fsl_edma->dma_dev.device_synchronize = fsl_edma_synchronize;
  539. fsl_edma->dma_dev.device_issue_pending = fsl_edma_issue_pending;
  540. fsl_edma->dma_dev.src_addr_widths = FSL_EDMA_BUSWIDTHS;
  541. fsl_edma->dma_dev.dst_addr_widths = FSL_EDMA_BUSWIDTHS;
  542. if (drvdata->flags & FSL_EDMA_DRV_BUS_8BYTE) {
  543. fsl_edma->dma_dev.src_addr_widths |= BIT(DMA_SLAVE_BUSWIDTH_8_BYTES);
  544. fsl_edma->dma_dev.dst_addr_widths |= BIT(DMA_SLAVE_BUSWIDTH_8_BYTES);
  545. }
  546. fsl_edma->dma_dev.directions = BIT(DMA_DEV_TO_MEM) | BIT(DMA_MEM_TO_DEV);
  547. if (drvdata->flags & FSL_EDMA_DRV_DEV_TO_DEV)
  548. fsl_edma->dma_dev.directions |= BIT(DMA_DEV_TO_DEV);
  549. fsl_edma->dma_dev.copy_align = drvdata->flags & FSL_EDMA_DRV_ALIGN_64BYTE ?
  550. DMAENGINE_ALIGN_64_BYTES :
  551. DMAENGINE_ALIGN_32_BYTES;
  552. /* Per worst case 'nbytes = 1' take CITER as the max_seg_size */
  553. dma_set_max_seg_size(fsl_edma->dma_dev.dev,
  554. FIELD_GET(EDMA_TCD_ITER_MASK, EDMA_TCD_ITER_MASK));
  555. fsl_edma->dma_dev.residue_granularity = DMA_RESIDUE_GRANULARITY_SEGMENT;
  556. platform_set_drvdata(pdev, fsl_edma);
  557. ret = dma_async_device_register(&fsl_edma->dma_dev);
  558. if (ret) {
  559. dev_err(&pdev->dev,
  560. "Can't register Freescale eDMA engine. (%d)\n", ret);
  561. return ret;
  562. }
  563. ret = of_dma_controller_register(np,
  564. drvdata->flags & FSL_EDMA_DRV_SPLIT_REG ? fsl_edma3_xlate : fsl_edma_xlate,
  565. fsl_edma);
  566. if (ret) {
  567. dev_err(&pdev->dev,
  568. "Can't register Freescale eDMA of_dma. (%d)\n", ret);
  569. dma_async_device_unregister(&fsl_edma->dma_dev);
  570. return ret;
  571. }
  572. /* enable round robin arbitration */
  573. if (!(drvdata->flags & FSL_EDMA_DRV_SPLIT_REG))
  574. edma_writel(fsl_edma, EDMA_CR_ERGA | EDMA_CR_ERCA, regs->cr);
  575. return 0;
  576. }
  577. static void fsl_edma_remove(struct platform_device *pdev)
  578. {
  579. struct device_node *np = pdev->dev.of_node;
  580. struct fsl_edma_engine *fsl_edma = platform_get_drvdata(pdev);
  581. fsl_edma_irq_exit(pdev, fsl_edma);
  582. of_dma_controller_free(np);
  583. dma_async_device_unregister(&fsl_edma->dma_dev);
  584. fsl_edma_cleanup_vchan(&fsl_edma->dma_dev);
  585. fsl_disable_clocks(fsl_edma, fsl_edma->drvdata->dmamuxs);
  586. }
  587. static int fsl_edma_suspend_late(struct device *dev)
  588. {
  589. struct fsl_edma_engine *fsl_edma = dev_get_drvdata(dev);
  590. struct fsl_edma_chan *fsl_chan;
  591. unsigned long flags;
  592. int i;
  593. for (i = 0; i < fsl_edma->n_chans; i++) {
  594. fsl_chan = &fsl_edma->chans[i];
  595. if (fsl_edma->chan_masked & BIT(i))
  596. continue;
  597. spin_lock_irqsave(&fsl_chan->vchan.lock, flags);
  598. /* Make sure chan is idle or will force disable. */
  599. if (unlikely(fsl_chan->status == DMA_IN_PROGRESS)) {
  600. dev_warn(dev, "WARN: There is non-idle channel.");
  601. fsl_edma_disable_request(fsl_chan);
  602. fsl_edma_chan_mux(fsl_chan, 0, false);
  603. }
  604. fsl_chan->pm_state = SUSPENDED;
  605. spin_unlock_irqrestore(&fsl_chan->vchan.lock, flags);
  606. }
  607. return 0;
  608. }
  609. static int fsl_edma_resume_early(struct device *dev)
  610. {
  611. struct fsl_edma_engine *fsl_edma = dev_get_drvdata(dev);
  612. struct fsl_edma_chan *fsl_chan;
  613. struct edma_regs *regs = &fsl_edma->regs;
  614. int i;
  615. for (i = 0; i < fsl_edma->n_chans; i++) {
  616. fsl_chan = &fsl_edma->chans[i];
  617. if (fsl_edma->chan_masked & BIT(i))
  618. continue;
  619. fsl_chan->pm_state = RUNNING;
  620. edma_write_tcdreg(fsl_chan, 0, csr);
  621. if (fsl_chan->srcid != 0)
  622. fsl_edma_chan_mux(fsl_chan, fsl_chan->srcid, true);
  623. }
  624. if (!(fsl_edma->drvdata->flags & FSL_EDMA_DRV_SPLIT_REG))
  625. edma_writel(fsl_edma, EDMA_CR_ERGA | EDMA_CR_ERCA, regs->cr);
  626. return 0;
  627. }
  628. /*
  629. * eDMA provides the service to others, so it should be suspend late
  630. * and resume early. When eDMA suspend, all of the clients should stop
  631. * the DMA data transmission and let the channel idle.
  632. */
  633. static const struct dev_pm_ops fsl_edma_pm_ops = {
  634. .suspend_late = fsl_edma_suspend_late,
  635. .resume_early = fsl_edma_resume_early,
  636. };
  637. static struct platform_driver fsl_edma_driver = {
  638. .driver = {
  639. .name = "fsl-edma",
  640. .of_match_table = fsl_edma_dt_ids,
  641. .pm = &fsl_edma_pm_ops,
  642. },
  643. .probe = fsl_edma_probe,
  644. .remove_new = fsl_edma_remove,
  645. };
  646. static int __init fsl_edma_init(void)
  647. {
  648. return platform_driver_register(&fsl_edma_driver);
  649. }
  650. subsys_initcall(fsl_edma_init);
  651. static void __exit fsl_edma_exit(void)
  652. {
  653. platform_driver_unregister(&fsl_edma_driver);
  654. }
  655. module_exit(fsl_edma_exit);
  656. MODULE_ALIAS("platform:fsl-edma");
  657. MODULE_DESCRIPTION("Freescale eDMA engine driver");
  658. MODULE_LICENSE("GPL v2");