mmp_tdma.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719
  1. /*
  2. * Driver For Marvell Two-channel DMA Engine
  3. *
  4. * Copyright: Marvell International Ltd.
  5. *
  6. * The code contained herein is licensed under the GNU General Public
  7. * License. You may obtain a copy of the GNU General Public License
  8. * Version 2 or later at the following locations:
  9. *
  10. */
  11. #include <linux/err.h>
  12. #include <linux/module.h>
  13. #include <linux/init.h>
  14. #include <linux/types.h>
  15. #include <linux/interrupt.h>
  16. #include <linux/dma-mapping.h>
  17. #include <linux/slab.h>
  18. #include <linux/dmaengine.h>
  19. #include <linux/platform_device.h>
  20. #include <linux/device.h>
  21. #include <mach/regs-icu.h>
  22. #include <linux/platform_data/dma-mmp_tdma.h>
  23. #include <linux/of_device.h>
  24. #include <linux/of_dma.h>
  25. #include "dmaengine.h"
  26. /*
  27. * Two-Channel DMA registers
  28. */
  29. #define TDBCR 0x00 /* Byte Count */
  30. #define TDSAR 0x10 /* Src Addr */
  31. #define TDDAR 0x20 /* Dst Addr */
  32. #define TDNDPR 0x30 /* Next Desc */
  33. #define TDCR 0x40 /* Control */
  34. #define TDCP 0x60 /* Priority*/
  35. #define TDCDPR 0x70 /* Current Desc */
  36. #define TDIMR 0x80 /* Int Mask */
  37. #define TDISR 0xa0 /* Int Status */
  38. /* Two-Channel DMA Control Register */
  39. #define TDCR_SSZ_8_BITS (0x0 << 22) /* Sample Size */
  40. #define TDCR_SSZ_12_BITS (0x1 << 22)
  41. #define TDCR_SSZ_16_BITS (0x2 << 22)
  42. #define TDCR_SSZ_20_BITS (0x3 << 22)
  43. #define TDCR_SSZ_24_BITS (0x4 << 22)
  44. #define TDCR_SSZ_32_BITS (0x5 << 22)
  45. #define TDCR_SSZ_SHIFT (0x1 << 22)
  46. #define TDCR_SSZ_MASK (0x7 << 22)
  47. #define TDCR_SSPMOD (0x1 << 21) /* SSP MOD */
  48. #define TDCR_ABR (0x1 << 20) /* Channel Abort */
  49. #define TDCR_CDE (0x1 << 17) /* Close Desc Enable */
  50. #define TDCR_PACKMOD (0x1 << 16) /* Pack Mode (ADMA Only) */
  51. #define TDCR_CHANACT (0x1 << 14) /* Channel Active */
  52. #define TDCR_FETCHND (0x1 << 13) /* Fetch Next Desc */
  53. #define TDCR_CHANEN (0x1 << 12) /* Channel Enable */
  54. #define TDCR_INTMODE (0x1 << 10) /* Interrupt Mode */
  55. #define TDCR_CHAINMOD (0x1 << 9) /* Chain Mode */
  56. #define TDCR_BURSTSZ_MSK (0x7 << 6) /* Burst Size */
  57. #define TDCR_BURSTSZ_4B (0x0 << 6)
  58. #define TDCR_BURSTSZ_8B (0x1 << 6)
  59. #define TDCR_BURSTSZ_16B (0x3 << 6)
  60. #define TDCR_BURSTSZ_32B (0x6 << 6)
  61. #define TDCR_BURSTSZ_64B (0x7 << 6)
  62. #define TDCR_BURSTSZ_SQU_1B (0x5 << 6)
  63. #define TDCR_BURSTSZ_SQU_2B (0x6 << 6)
  64. #define TDCR_BURSTSZ_SQU_4B (0x0 << 6)
  65. #define TDCR_BURSTSZ_SQU_8B (0x1 << 6)
  66. #define TDCR_BURSTSZ_SQU_16B (0x3 << 6)
  67. #define TDCR_BURSTSZ_SQU_32B (0x7 << 6)
  68. #define TDCR_BURSTSZ_128B (0x5 << 6)
  69. #define TDCR_DSTDIR_MSK (0x3 << 4) /* Dst Direction */
  70. #define TDCR_DSTDIR_ADDR_HOLD (0x2 << 4) /* Dst Addr Hold */
  71. #define TDCR_DSTDIR_ADDR_INC (0x0 << 4) /* Dst Addr Increment */
  72. #define TDCR_SRCDIR_MSK (0x3 << 2) /* Src Direction */
  73. #define TDCR_SRCDIR_ADDR_HOLD (0x2 << 2) /* Src Addr Hold */
  74. #define TDCR_SRCDIR_ADDR_INC (0x0 << 2) /* Src Addr Increment */
  75. #define TDCR_DSTDESCCONT (0x1 << 1)
  76. #define TDCR_SRCDESTCONT (0x1 << 0)
  77. /* Two-Channel DMA Int Mask Register */
  78. #define TDIMR_COMP (0x1 << 0)
  79. /* Two-Channel DMA Int Status Register */
  80. #define TDISR_COMP (0x1 << 0)
  81. /*
  82. * Two-Channel DMA Descriptor Struct
  83. * NOTE: desc's buf must be aligned to 16 bytes.
  84. */
  85. struct mmp_tdma_desc {
  86. u32 byte_cnt;
  87. u32 src_addr;
  88. u32 dst_addr;
  89. u32 nxt_desc;
  90. };
  91. enum mmp_tdma_type {
  92. MMP_AUD_TDMA = 0,
  93. PXA910_SQU,
  94. };
  95. #define TDMA_ALIGNMENT 3
  96. #define TDMA_MAX_XFER_BYTES SZ_64K
  97. struct mmp_tdma_chan {
  98. struct device *dev;
  99. struct dma_chan chan;
  100. struct dma_async_tx_descriptor desc;
  101. struct tasklet_struct tasklet;
  102. struct mmp_tdma_desc *desc_arr;
  103. phys_addr_t desc_arr_phys;
  104. int desc_num;
  105. enum dma_transfer_direction dir;
  106. dma_addr_t dev_addr;
  107. u32 burst_sz;
  108. enum dma_slave_buswidth buswidth;
  109. enum dma_status status;
  110. int idx;
  111. enum mmp_tdma_type type;
  112. int irq;
  113. void __iomem *reg_base;
  114. size_t buf_len;
  115. size_t period_len;
  116. size_t pos;
  117. struct gen_pool *pool;
  118. };
  119. #define TDMA_CHANNEL_NUM 2
  120. struct mmp_tdma_device {
  121. struct device *dev;
  122. void __iomem *base;
  123. struct dma_device device;
  124. struct mmp_tdma_chan *tdmac[TDMA_CHANNEL_NUM];
  125. };
  126. #define to_mmp_tdma_chan(dchan) container_of(dchan, struct mmp_tdma_chan, chan)
  127. static void mmp_tdma_chan_set_desc(struct mmp_tdma_chan *tdmac, dma_addr_t phys)
  128. {
  129. writel(phys, tdmac->reg_base + TDNDPR);
  130. writel(readl(tdmac->reg_base + TDCR) | TDCR_FETCHND,
  131. tdmac->reg_base + TDCR);
  132. }
  133. static void mmp_tdma_enable_irq(struct mmp_tdma_chan *tdmac, bool enable)
  134. {
  135. if (enable)
  136. writel(TDIMR_COMP, tdmac->reg_base + TDIMR);
  137. else
  138. writel(0, tdmac->reg_base + TDIMR);
  139. }
  140. static void mmp_tdma_enable_chan(struct mmp_tdma_chan *tdmac)
  141. {
  142. /* enable dma chan */
  143. writel(readl(tdmac->reg_base + TDCR) | TDCR_CHANEN,
  144. tdmac->reg_base + TDCR);
  145. tdmac->status = DMA_IN_PROGRESS;
  146. }
  147. static void mmp_tdma_disable_chan(struct mmp_tdma_chan *tdmac)
  148. {
  149. writel(readl(tdmac->reg_base + TDCR) & ~TDCR_CHANEN,
  150. tdmac->reg_base + TDCR);
  151. tdmac->status = DMA_COMPLETE;
  152. }
  153. static void mmp_tdma_resume_chan(struct mmp_tdma_chan *tdmac)
  154. {
  155. writel(readl(tdmac->reg_base + TDCR) | TDCR_CHANEN,
  156. tdmac->reg_base + TDCR);
  157. tdmac->status = DMA_IN_PROGRESS;
  158. }
  159. static void mmp_tdma_pause_chan(struct mmp_tdma_chan *tdmac)
  160. {
  161. writel(readl(tdmac->reg_base + TDCR) & ~TDCR_CHANEN,
  162. tdmac->reg_base + TDCR);
  163. tdmac->status = DMA_PAUSED;
  164. }
  165. static int mmp_tdma_config_chan(struct mmp_tdma_chan *tdmac)
  166. {
  167. unsigned int tdcr = 0;
  168. mmp_tdma_disable_chan(tdmac);
  169. if (tdmac->dir == DMA_MEM_TO_DEV)
  170. tdcr = TDCR_DSTDIR_ADDR_HOLD | TDCR_SRCDIR_ADDR_INC;
  171. else if (tdmac->dir == DMA_DEV_TO_MEM)
  172. tdcr = TDCR_SRCDIR_ADDR_HOLD | TDCR_DSTDIR_ADDR_INC;
  173. if (tdmac->type == MMP_AUD_TDMA) {
  174. tdcr |= TDCR_PACKMOD;
  175. switch (tdmac->burst_sz) {
  176. case 4:
  177. tdcr |= TDCR_BURSTSZ_4B;
  178. break;
  179. case 8:
  180. tdcr |= TDCR_BURSTSZ_8B;
  181. break;
  182. case 16:
  183. tdcr |= TDCR_BURSTSZ_16B;
  184. break;
  185. case 32:
  186. tdcr |= TDCR_BURSTSZ_32B;
  187. break;
  188. case 64:
  189. tdcr |= TDCR_BURSTSZ_64B;
  190. break;
  191. case 128:
  192. tdcr |= TDCR_BURSTSZ_128B;
  193. break;
  194. default:
  195. dev_err(tdmac->dev, "mmp_tdma: unknown burst size.\n");
  196. return -EINVAL;
  197. }
  198. switch (tdmac->buswidth) {
  199. case DMA_SLAVE_BUSWIDTH_1_BYTE:
  200. tdcr |= TDCR_SSZ_8_BITS;
  201. break;
  202. case DMA_SLAVE_BUSWIDTH_2_BYTES:
  203. tdcr |= TDCR_SSZ_16_BITS;
  204. break;
  205. case DMA_SLAVE_BUSWIDTH_4_BYTES:
  206. tdcr |= TDCR_SSZ_32_BITS;
  207. break;
  208. default:
  209. dev_err(tdmac->dev, "mmp_tdma: unknown bus size.\n");
  210. return -EINVAL;
  211. }
  212. } else if (tdmac->type == PXA910_SQU) {
  213. tdcr |= TDCR_SSPMOD;
  214. switch (tdmac->burst_sz) {
  215. case 1:
  216. tdcr |= TDCR_BURSTSZ_SQU_1B;
  217. break;
  218. case 2:
  219. tdcr |= TDCR_BURSTSZ_SQU_2B;
  220. break;
  221. case 4:
  222. tdcr |= TDCR_BURSTSZ_SQU_4B;
  223. break;
  224. case 8:
  225. tdcr |= TDCR_BURSTSZ_SQU_8B;
  226. break;
  227. case 16:
  228. tdcr |= TDCR_BURSTSZ_SQU_16B;
  229. break;
  230. case 32:
  231. tdcr |= TDCR_BURSTSZ_SQU_32B;
  232. break;
  233. default:
  234. dev_err(tdmac->dev, "mmp_tdma: unknown burst size.\n");
  235. return -EINVAL;
  236. }
  237. }
  238. writel(tdcr, tdmac->reg_base + TDCR);
  239. return 0;
  240. }
  241. static int mmp_tdma_clear_chan_irq(struct mmp_tdma_chan *tdmac)
  242. {
  243. u32 reg = readl(tdmac->reg_base + TDISR);
  244. if (reg & TDISR_COMP) {
  245. /* clear irq */
  246. reg &= ~TDISR_COMP;
  247. writel(reg, tdmac->reg_base + TDISR);
  248. return 0;
  249. }
  250. return -EAGAIN;
  251. }
  252. static irqreturn_t mmp_tdma_chan_handler(int irq, void *dev_id)
  253. {
  254. struct mmp_tdma_chan *tdmac = dev_id;
  255. if (mmp_tdma_clear_chan_irq(tdmac) == 0) {
  256. tdmac->pos = (tdmac->pos + tdmac->period_len) % tdmac->buf_len;
  257. tasklet_schedule(&tdmac->tasklet);
  258. return IRQ_HANDLED;
  259. } else
  260. return IRQ_NONE;
  261. }
  262. static irqreturn_t mmp_tdma_int_handler(int irq, void *dev_id)
  263. {
  264. struct mmp_tdma_device *tdev = dev_id;
  265. int i, ret;
  266. int irq_num = 0;
  267. for (i = 0; i < TDMA_CHANNEL_NUM; i++) {
  268. struct mmp_tdma_chan *tdmac = tdev->tdmac[i];
  269. ret = mmp_tdma_chan_handler(irq, tdmac);
  270. if (ret == IRQ_HANDLED)
  271. irq_num++;
  272. }
  273. if (irq_num)
  274. return IRQ_HANDLED;
  275. else
  276. return IRQ_NONE;
  277. }
  278. static void dma_do_tasklet(unsigned long data)
  279. {
  280. struct mmp_tdma_chan *tdmac = (struct mmp_tdma_chan *)data;
  281. if (tdmac->desc.callback)
  282. tdmac->desc.callback(tdmac->desc.callback_param);
  283. }
  284. static void mmp_tdma_free_descriptor(struct mmp_tdma_chan *tdmac)
  285. {
  286. struct gen_pool *gpool;
  287. int size = tdmac->desc_num * sizeof(struct mmp_tdma_desc);
  288. gpool = tdmac->pool;
  289. if (tdmac->desc_arr)
  290. gen_pool_free(gpool, (unsigned long)tdmac->desc_arr,
  291. size);
  292. tdmac->desc_arr = NULL;
  293. return;
  294. }
  295. static dma_cookie_t mmp_tdma_tx_submit(struct dma_async_tx_descriptor *tx)
  296. {
  297. struct mmp_tdma_chan *tdmac = to_mmp_tdma_chan(tx->chan);
  298. mmp_tdma_chan_set_desc(tdmac, tdmac->desc_arr_phys);
  299. return 0;
  300. }
  301. static int mmp_tdma_alloc_chan_resources(struct dma_chan *chan)
  302. {
  303. struct mmp_tdma_chan *tdmac = to_mmp_tdma_chan(chan);
  304. int ret;
  305. dma_async_tx_descriptor_init(&tdmac->desc, chan);
  306. tdmac->desc.tx_submit = mmp_tdma_tx_submit;
  307. if (tdmac->irq) {
  308. ret = devm_request_irq(tdmac->dev, tdmac->irq,
  309. mmp_tdma_chan_handler, 0, "tdma", tdmac);
  310. if (ret)
  311. return ret;
  312. }
  313. return 1;
  314. }
  315. static void mmp_tdma_free_chan_resources(struct dma_chan *chan)
  316. {
  317. struct mmp_tdma_chan *tdmac = to_mmp_tdma_chan(chan);
  318. if (tdmac->irq)
  319. devm_free_irq(tdmac->dev, tdmac->irq, tdmac);
  320. mmp_tdma_free_descriptor(tdmac);
  321. return;
  322. }
  323. struct mmp_tdma_desc *mmp_tdma_alloc_descriptor(struct mmp_tdma_chan *tdmac)
  324. {
  325. struct gen_pool *gpool;
  326. int size = tdmac->desc_num * sizeof(struct mmp_tdma_desc);
  327. gpool = tdmac->pool;
  328. if (!gpool)
  329. return NULL;
  330. tdmac->desc_arr = gen_pool_dma_alloc(gpool, size, &tdmac->desc_arr_phys);
  331. return tdmac->desc_arr;
  332. }
  333. static struct dma_async_tx_descriptor *mmp_tdma_prep_dma_cyclic(
  334. struct dma_chan *chan, dma_addr_t dma_addr, size_t buf_len,
  335. size_t period_len, enum dma_transfer_direction direction,
  336. unsigned long flags)
  337. {
  338. struct mmp_tdma_chan *tdmac = to_mmp_tdma_chan(chan);
  339. struct mmp_tdma_desc *desc;
  340. int num_periods = buf_len / period_len;
  341. int i = 0, buf = 0;
  342. if (tdmac->status != DMA_COMPLETE)
  343. return NULL;
  344. if (period_len > TDMA_MAX_XFER_BYTES) {
  345. dev_err(tdmac->dev,
  346. "maximum period size exceeded: %d > %d\n",
  347. period_len, TDMA_MAX_XFER_BYTES);
  348. goto err_out;
  349. }
  350. tdmac->status = DMA_IN_PROGRESS;
  351. tdmac->desc_num = num_periods;
  352. desc = mmp_tdma_alloc_descriptor(tdmac);
  353. if (!desc)
  354. goto err_out;
  355. while (buf < buf_len) {
  356. desc = &tdmac->desc_arr[i];
  357. if (i + 1 == num_periods)
  358. desc->nxt_desc = tdmac->desc_arr_phys;
  359. else
  360. desc->nxt_desc = tdmac->desc_arr_phys +
  361. sizeof(*desc) * (i + 1);
  362. if (direction == DMA_MEM_TO_DEV) {
  363. desc->src_addr = dma_addr;
  364. desc->dst_addr = tdmac->dev_addr;
  365. } else {
  366. desc->src_addr = tdmac->dev_addr;
  367. desc->dst_addr = dma_addr;
  368. }
  369. desc->byte_cnt = period_len;
  370. dma_addr += period_len;
  371. buf += period_len;
  372. i++;
  373. }
  374. /* enable interrupt */
  375. if (flags & DMA_PREP_INTERRUPT)
  376. mmp_tdma_enable_irq(tdmac, true);
  377. tdmac->buf_len = buf_len;
  378. tdmac->period_len = period_len;
  379. tdmac->pos = 0;
  380. return &tdmac->desc;
  381. err_out:
  382. tdmac->status = DMA_ERROR;
  383. return NULL;
  384. }
  385. static int mmp_tdma_control(struct dma_chan *chan, enum dma_ctrl_cmd cmd,
  386. unsigned long arg)
  387. {
  388. struct mmp_tdma_chan *tdmac = to_mmp_tdma_chan(chan);
  389. struct dma_slave_config *dmaengine_cfg = (void *)arg;
  390. int ret = 0;
  391. switch (cmd) {
  392. case DMA_TERMINATE_ALL:
  393. mmp_tdma_disable_chan(tdmac);
  394. /* disable interrupt */
  395. mmp_tdma_enable_irq(tdmac, false);
  396. break;
  397. case DMA_PAUSE:
  398. mmp_tdma_pause_chan(tdmac);
  399. break;
  400. case DMA_RESUME:
  401. mmp_tdma_resume_chan(tdmac);
  402. break;
  403. case DMA_SLAVE_CONFIG:
  404. if (dmaengine_cfg->direction == DMA_DEV_TO_MEM) {
  405. tdmac->dev_addr = dmaengine_cfg->src_addr;
  406. tdmac->burst_sz = dmaengine_cfg->src_maxburst;
  407. tdmac->buswidth = dmaengine_cfg->src_addr_width;
  408. } else {
  409. tdmac->dev_addr = dmaengine_cfg->dst_addr;
  410. tdmac->burst_sz = dmaengine_cfg->dst_maxburst;
  411. tdmac->buswidth = dmaengine_cfg->dst_addr_width;
  412. }
  413. tdmac->dir = dmaengine_cfg->direction;
  414. return mmp_tdma_config_chan(tdmac);
  415. default:
  416. ret = -ENOSYS;
  417. }
  418. return ret;
  419. }
  420. static enum dma_status mmp_tdma_tx_status(struct dma_chan *chan,
  421. dma_cookie_t cookie, struct dma_tx_state *txstate)
  422. {
  423. struct mmp_tdma_chan *tdmac = to_mmp_tdma_chan(chan);
  424. dma_set_tx_state(txstate, chan->completed_cookie, chan->cookie,
  425. tdmac->buf_len - tdmac->pos);
  426. return tdmac->status;
  427. }
  428. static void mmp_tdma_issue_pending(struct dma_chan *chan)
  429. {
  430. struct mmp_tdma_chan *tdmac = to_mmp_tdma_chan(chan);
  431. mmp_tdma_enable_chan(tdmac);
  432. }
  433. static int mmp_tdma_remove(struct platform_device *pdev)
  434. {
  435. struct mmp_tdma_device *tdev = platform_get_drvdata(pdev);
  436. dma_async_device_unregister(&tdev->device);
  437. return 0;
  438. }
  439. static int mmp_tdma_chan_init(struct mmp_tdma_device *tdev,
  440. int idx, int irq,
  441. int type, struct gen_pool *pool)
  442. {
  443. struct mmp_tdma_chan *tdmac;
  444. if (idx >= TDMA_CHANNEL_NUM) {
  445. dev_err(tdev->dev, "too many channels for device!\n");
  446. return -EINVAL;
  447. }
  448. /* alloc channel */
  449. tdmac = devm_kzalloc(tdev->dev, sizeof(*tdmac), GFP_KERNEL);
  450. if (!tdmac) {
  451. dev_err(tdev->dev, "no free memory for DMA channels!\n");
  452. return -ENOMEM;
  453. }
  454. if (irq)
  455. tdmac->irq = irq;
  456. tdmac->dev = tdev->dev;
  457. tdmac->chan.device = &tdev->device;
  458. tdmac->idx = idx;
  459. tdmac->type = type;
  460. tdmac->reg_base = tdev->base + idx * 4;
  461. tdmac->pool = pool;
  462. tdmac->status = DMA_COMPLETE;
  463. tdev->tdmac[tdmac->idx] = tdmac;
  464. tasklet_init(&tdmac->tasklet, dma_do_tasklet, (unsigned long)tdmac);
  465. /* add the channel to tdma_chan list */
  466. list_add_tail(&tdmac->chan.device_node,
  467. &tdev->device.channels);
  468. return 0;
  469. }
  470. struct mmp_tdma_filter_param {
  471. struct device_node *of_node;
  472. unsigned int chan_id;
  473. };
  474. static bool mmp_tdma_filter_fn(struct dma_chan *chan, void *fn_param)
  475. {
  476. struct mmp_tdma_filter_param *param = fn_param;
  477. struct mmp_tdma_chan *tdmac = to_mmp_tdma_chan(chan);
  478. struct dma_device *pdma_device = tdmac->chan.device;
  479. if (pdma_device->dev->of_node != param->of_node)
  480. return false;
  481. if (chan->chan_id != param->chan_id)
  482. return false;
  483. return true;
  484. }
  485. struct dma_chan *mmp_tdma_xlate(struct of_phandle_args *dma_spec,
  486. struct of_dma *ofdma)
  487. {
  488. struct mmp_tdma_device *tdev = ofdma->of_dma_data;
  489. dma_cap_mask_t mask = tdev->device.cap_mask;
  490. struct mmp_tdma_filter_param param;
  491. if (dma_spec->args_count != 1)
  492. return NULL;
  493. param.of_node = ofdma->of_node;
  494. param.chan_id = dma_spec->args[0];
  495. if (param.chan_id >= TDMA_CHANNEL_NUM)
  496. return NULL;
  497. return dma_request_channel(mask, mmp_tdma_filter_fn, &param);
  498. }
  499. static struct of_device_id mmp_tdma_dt_ids[] = {
  500. { .compatible = "marvell,adma-1.0", .data = (void *)MMP_AUD_TDMA},
  501. { .compatible = "marvell,pxa910-squ", .data = (void *)PXA910_SQU},
  502. {}
  503. };
  504. MODULE_DEVICE_TABLE(of, mmp_tdma_dt_ids);
  505. static int mmp_tdma_probe(struct platform_device *pdev)
  506. {
  507. enum mmp_tdma_type type;
  508. const struct of_device_id *of_id;
  509. struct mmp_tdma_device *tdev;
  510. struct resource *iores;
  511. int i, ret;
  512. int irq = 0, irq_num = 0;
  513. int chan_num = TDMA_CHANNEL_NUM;
  514. struct gen_pool *pool;
  515. of_id = of_match_device(mmp_tdma_dt_ids, &pdev->dev);
  516. if (of_id)
  517. type = (enum mmp_tdma_type) of_id->data;
  518. else
  519. type = platform_get_device_id(pdev)->driver_data;
  520. /* always have couple channels */
  521. tdev = devm_kzalloc(&pdev->dev, sizeof(*tdev), GFP_KERNEL);
  522. if (!tdev)
  523. return -ENOMEM;
  524. tdev->dev = &pdev->dev;
  525. for (i = 0; i < chan_num; i++) {
  526. if (platform_get_irq(pdev, i) > 0)
  527. irq_num++;
  528. }
  529. iores = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  530. tdev->base = devm_ioremap_resource(&pdev->dev, iores);
  531. if (IS_ERR(tdev->base))
  532. return PTR_ERR(tdev->base);
  533. INIT_LIST_HEAD(&tdev->device.channels);
  534. if (pdev->dev.of_node)
  535. pool = of_get_named_gen_pool(pdev->dev.of_node, "asram", 0);
  536. else
  537. pool = sram_get_gpool("asram");
  538. if (!pool) {
  539. dev_err(&pdev->dev, "asram pool not available\n");
  540. return -ENOMEM;
  541. }
  542. if (irq_num != chan_num) {
  543. irq = platform_get_irq(pdev, 0);
  544. ret = devm_request_irq(&pdev->dev, irq,
  545. mmp_tdma_int_handler, 0, "tdma", tdev);
  546. if (ret)
  547. return ret;
  548. }
  549. /* initialize channel parameters */
  550. for (i = 0; i < chan_num; i++) {
  551. irq = (irq_num != chan_num) ? 0 : platform_get_irq(pdev, i);
  552. ret = mmp_tdma_chan_init(tdev, i, irq, type, pool);
  553. if (ret)
  554. return ret;
  555. }
  556. dma_cap_set(DMA_SLAVE, tdev->device.cap_mask);
  557. dma_cap_set(DMA_CYCLIC, tdev->device.cap_mask);
  558. tdev->device.dev = &pdev->dev;
  559. tdev->device.device_alloc_chan_resources =
  560. mmp_tdma_alloc_chan_resources;
  561. tdev->device.device_free_chan_resources =
  562. mmp_tdma_free_chan_resources;
  563. tdev->device.device_prep_dma_cyclic = mmp_tdma_prep_dma_cyclic;
  564. tdev->device.device_tx_status = mmp_tdma_tx_status;
  565. tdev->device.device_issue_pending = mmp_tdma_issue_pending;
  566. tdev->device.device_control = mmp_tdma_control;
  567. tdev->device.copy_align = TDMA_ALIGNMENT;
  568. dma_set_mask(&pdev->dev, DMA_BIT_MASK(64));
  569. platform_set_drvdata(pdev, tdev);
  570. ret = dma_async_device_register(&tdev->device);
  571. if (ret) {
  572. dev_err(tdev->device.dev, "unable to register\n");
  573. return ret;
  574. }
  575. if (pdev->dev.of_node) {
  576. ret = of_dma_controller_register(pdev->dev.of_node,
  577. mmp_tdma_xlate, tdev);
  578. if (ret) {
  579. dev_err(tdev->device.dev,
  580. "failed to register controller\n");
  581. dma_async_device_unregister(&tdev->device);
  582. }
  583. }
  584. dev_info(tdev->device.dev, "initialized\n");
  585. return 0;
  586. }
  587. static const struct platform_device_id mmp_tdma_id_table[] = {
  588. { "mmp-adma", MMP_AUD_TDMA },
  589. { "pxa910-squ", PXA910_SQU },
  590. { },
  591. };
  592. static struct platform_driver mmp_tdma_driver = {
  593. .driver = {
  594. .name = "mmp-tdma",
  595. .of_match_table = mmp_tdma_dt_ids,
  596. },
  597. .id_table = mmp_tdma_id_table,
  598. .probe = mmp_tdma_probe,
  599. .remove = mmp_tdma_remove,
  600. };
  601. module_platform_driver(mmp_tdma_driver);
  602. MODULE_LICENSE("GPL");
  603. MODULE_DESCRIPTION("MMP Two-Channel DMA Driver");
  604. MODULE_ALIAS("platform:mmp-tdma");
  605. MODULE_AUTHOR("Leo Yan <leoy@marvell.com>");
  606. MODULE_AUTHOR("Zhangfei Gao <zhangfei.gao@marvell.com>");