shdmac.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954
  1. /*
  2. * Renesas SuperH DMA Engine support
  3. *
  4. * base is drivers/dma/flsdma.c
  5. *
  6. * Copyright (C) 2011-2012 Guennadi Liakhovetski <g.liakhovetski@gmx.de>
  7. * Copyright (C) 2009 Nobuhiro Iwamatsu <iwamatsu.nobuhiro@renesas.com>
  8. * Copyright (C) 2009 Renesas Solutions, Inc. All rights reserved.
  9. * Copyright (C) 2007 Freescale Semiconductor, Inc. All rights reserved.
  10. *
  11. * This is free software; you can redistribute it and/or modify
  12. * it under the terms of the GNU General Public License as published by
  13. * the Free Software Foundation; either version 2 of the License, or
  14. * (at your option) any later version.
  15. *
  16. * - DMA of SuperH does not have Hardware DMA chain mode.
  17. * - MAX DMA size is 16MB.
  18. *
  19. */
  20. #include <linux/init.h>
  21. #include <linux/module.h>
  22. #include <linux/of.h>
  23. #include <linux/of_device.h>
  24. #include <linux/slab.h>
  25. #include <linux/interrupt.h>
  26. #include <linux/dmaengine.h>
  27. #include <linux/delay.h>
  28. #include <linux/platform_device.h>
  29. #include <linux/pm_runtime.h>
  30. #include <linux/sh_dma.h>
  31. #include <linux/notifier.h>
  32. #include <linux/kdebug.h>
  33. #include <linux/spinlock.h>
  34. #include <linux/rculist.h>
  35. #include "../dmaengine.h"
  36. #include "shdma.h"
  37. /* DMA register */
  38. #define SAR 0x00
  39. #define DAR 0x04
  40. #define TCR 0x08
  41. #define CHCR 0x0C
  42. #define DMAOR 0x40
  43. #define TEND 0x18 /* USB-DMAC */
  44. #define SH_DMAE_DRV_NAME "sh-dma-engine"
  45. /* Default MEMCPY transfer size = 2^2 = 4 bytes */
  46. #define LOG2_DEFAULT_XFER_SIZE 2
  47. #define SH_DMA_SLAVE_NUMBER 256
  48. #define SH_DMA_TCR_MAX (16 * 1024 * 1024 - 1)
  49. /*
  50. * Used for write-side mutual exclusion for the global device list,
  51. * read-side synchronization by way of RCU, and per-controller data.
  52. */
  53. static DEFINE_SPINLOCK(sh_dmae_lock);
  54. static LIST_HEAD(sh_dmae_devices);
  55. /*
  56. * Different DMAC implementations provide different ways to clear DMA channels:
  57. * (1) none - no CHCLR registers are available
  58. * (2) one CHCLR register per channel - 0 has to be written to it to clear
  59. * channel buffers
  60. * (3) one CHCLR per several channels - 1 has to be written to the bit,
  61. * corresponding to the specific channel to reset it
  62. */
  63. static void channel_clear(struct sh_dmae_chan *sh_dc)
  64. {
  65. struct sh_dmae_device *shdev = to_sh_dev(sh_dc);
  66. const struct sh_dmae_channel *chan_pdata = shdev->pdata->channel +
  67. sh_dc->shdma_chan.id;
  68. u32 val = shdev->pdata->chclr_bitwise ? 1 << chan_pdata->chclr_bit : 0;
  69. __raw_writel(val, shdev->chan_reg + chan_pdata->chclr_offset);
  70. }
  71. static void sh_dmae_writel(struct sh_dmae_chan *sh_dc, u32 data, u32 reg)
  72. {
  73. __raw_writel(data, sh_dc->base + reg);
  74. }
  75. static u32 sh_dmae_readl(struct sh_dmae_chan *sh_dc, u32 reg)
  76. {
  77. return __raw_readl(sh_dc->base + reg);
  78. }
  79. static u16 dmaor_read(struct sh_dmae_device *shdev)
  80. {
  81. void __iomem *addr = shdev->chan_reg + DMAOR;
  82. if (shdev->pdata->dmaor_is_32bit)
  83. return __raw_readl(addr);
  84. else
  85. return __raw_readw(addr);
  86. }
  87. static void dmaor_write(struct sh_dmae_device *shdev, u16 data)
  88. {
  89. void __iomem *addr = shdev->chan_reg + DMAOR;
  90. if (shdev->pdata->dmaor_is_32bit)
  91. __raw_writel(data, addr);
  92. else
  93. __raw_writew(data, addr);
  94. }
  95. static void chcr_write(struct sh_dmae_chan *sh_dc, u32 data)
  96. {
  97. struct sh_dmae_device *shdev = to_sh_dev(sh_dc);
  98. __raw_writel(data, sh_dc->base + shdev->chcr_offset);
  99. }
  100. static u32 chcr_read(struct sh_dmae_chan *sh_dc)
  101. {
  102. struct sh_dmae_device *shdev = to_sh_dev(sh_dc);
  103. return __raw_readl(sh_dc->base + shdev->chcr_offset);
  104. }
  105. /*
  106. * Reset DMA controller
  107. *
  108. * SH7780 has two DMAOR register
  109. */
  110. static void sh_dmae_ctl_stop(struct sh_dmae_device *shdev)
  111. {
  112. unsigned short dmaor;
  113. unsigned long flags;
  114. spin_lock_irqsave(&sh_dmae_lock, flags);
  115. dmaor = dmaor_read(shdev);
  116. dmaor_write(shdev, dmaor & ~(DMAOR_NMIF | DMAOR_AE | DMAOR_DME));
  117. spin_unlock_irqrestore(&sh_dmae_lock, flags);
  118. }
  119. static int sh_dmae_rst(struct sh_dmae_device *shdev)
  120. {
  121. unsigned short dmaor;
  122. unsigned long flags;
  123. spin_lock_irqsave(&sh_dmae_lock, flags);
  124. dmaor = dmaor_read(shdev) & ~(DMAOR_NMIF | DMAOR_AE | DMAOR_DME);
  125. if (shdev->pdata->chclr_present) {
  126. int i;
  127. for (i = 0; i < shdev->pdata->channel_num; i++) {
  128. struct sh_dmae_chan *sh_chan = shdev->chan[i];
  129. if (sh_chan)
  130. channel_clear(sh_chan);
  131. }
  132. }
  133. dmaor_write(shdev, dmaor | shdev->pdata->dmaor_init);
  134. dmaor = dmaor_read(shdev);
  135. spin_unlock_irqrestore(&sh_dmae_lock, flags);
  136. if (dmaor & (DMAOR_AE | DMAOR_NMIF)) {
  137. dev_warn(shdev->shdma_dev.dma_dev.dev, "Can't initialize DMAOR.\n");
  138. return -EIO;
  139. }
  140. if (shdev->pdata->dmaor_init & ~dmaor)
  141. dev_warn(shdev->shdma_dev.dma_dev.dev,
  142. "DMAOR=0x%x hasn't latched the initial value 0x%x.\n",
  143. dmaor, shdev->pdata->dmaor_init);
  144. return 0;
  145. }
  146. static bool dmae_is_busy(struct sh_dmae_chan *sh_chan)
  147. {
  148. u32 chcr = chcr_read(sh_chan);
  149. if ((chcr & (CHCR_DE | CHCR_TE)) == CHCR_DE)
  150. return true; /* working */
  151. return false; /* waiting */
  152. }
  153. static unsigned int calc_xmit_shift(struct sh_dmae_chan *sh_chan, u32 chcr)
  154. {
  155. struct sh_dmae_device *shdev = to_sh_dev(sh_chan);
  156. const struct sh_dmae_pdata *pdata = shdev->pdata;
  157. int cnt = ((chcr & pdata->ts_low_mask) >> pdata->ts_low_shift) |
  158. ((chcr & pdata->ts_high_mask) >> pdata->ts_high_shift);
  159. if (cnt >= pdata->ts_shift_num)
  160. cnt = 0;
  161. return pdata->ts_shift[cnt];
  162. }
  163. static u32 log2size_to_chcr(struct sh_dmae_chan *sh_chan, int l2size)
  164. {
  165. struct sh_dmae_device *shdev = to_sh_dev(sh_chan);
  166. const struct sh_dmae_pdata *pdata = shdev->pdata;
  167. int i;
  168. for (i = 0; i < pdata->ts_shift_num; i++)
  169. if (pdata->ts_shift[i] == l2size)
  170. break;
  171. if (i == pdata->ts_shift_num)
  172. i = 0;
  173. return ((i << pdata->ts_low_shift) & pdata->ts_low_mask) |
  174. ((i << pdata->ts_high_shift) & pdata->ts_high_mask);
  175. }
  176. static void dmae_set_reg(struct sh_dmae_chan *sh_chan, struct sh_dmae_regs *hw)
  177. {
  178. sh_dmae_writel(sh_chan, hw->sar, SAR);
  179. sh_dmae_writel(sh_chan, hw->dar, DAR);
  180. sh_dmae_writel(sh_chan, hw->tcr >> sh_chan->xmit_shift, TCR);
  181. }
  182. static void dmae_start(struct sh_dmae_chan *sh_chan)
  183. {
  184. struct sh_dmae_device *shdev = to_sh_dev(sh_chan);
  185. u32 chcr = chcr_read(sh_chan);
  186. if (shdev->pdata->needs_tend_set)
  187. sh_dmae_writel(sh_chan, 0xFFFFFFFF, TEND);
  188. chcr |= CHCR_DE | shdev->chcr_ie_bit;
  189. chcr_write(sh_chan, chcr & ~CHCR_TE);
  190. }
  191. static void dmae_init(struct sh_dmae_chan *sh_chan)
  192. {
  193. /*
  194. * Default configuration for dual address memory-memory transfer.
  195. * 0x400 represents auto-request.
  196. */
  197. u32 chcr = DM_INC | SM_INC | 0x400 | log2size_to_chcr(sh_chan,
  198. LOG2_DEFAULT_XFER_SIZE);
  199. sh_chan->xmit_shift = calc_xmit_shift(sh_chan, chcr);
  200. chcr_write(sh_chan, chcr);
  201. }
  202. static int dmae_set_chcr(struct sh_dmae_chan *sh_chan, u32 val)
  203. {
  204. /* If DMA is active, cannot set CHCR. TODO: remove this superfluous check */
  205. if (dmae_is_busy(sh_chan))
  206. return -EBUSY;
  207. sh_chan->xmit_shift = calc_xmit_shift(sh_chan, val);
  208. chcr_write(sh_chan, val);
  209. return 0;
  210. }
  211. static int dmae_set_dmars(struct sh_dmae_chan *sh_chan, u16 val)
  212. {
  213. struct sh_dmae_device *shdev = to_sh_dev(sh_chan);
  214. const struct sh_dmae_pdata *pdata = shdev->pdata;
  215. const struct sh_dmae_channel *chan_pdata = &pdata->channel[sh_chan->shdma_chan.id];
  216. void __iomem *addr = shdev->dmars;
  217. unsigned int shift = chan_pdata->dmars_bit;
  218. if (dmae_is_busy(sh_chan))
  219. return -EBUSY;
  220. if (pdata->no_dmars)
  221. return 0;
  222. /* in the case of a missing DMARS resource use first memory window */
  223. if (!addr)
  224. addr = shdev->chan_reg;
  225. addr += chan_pdata->dmars;
  226. __raw_writew((__raw_readw(addr) & (0xff00 >> shift)) | (val << shift),
  227. addr);
  228. return 0;
  229. }
  230. static void sh_dmae_start_xfer(struct shdma_chan *schan,
  231. struct shdma_desc *sdesc)
  232. {
  233. struct sh_dmae_chan *sh_chan = container_of(schan, struct sh_dmae_chan,
  234. shdma_chan);
  235. struct sh_dmae_desc *sh_desc = container_of(sdesc,
  236. struct sh_dmae_desc, shdma_desc);
  237. dev_dbg(sh_chan->shdma_chan.dev, "Queue #%d to %d: %u@%x -> %x\n",
  238. sdesc->async_tx.cookie, sh_chan->shdma_chan.id,
  239. sh_desc->hw.tcr, sh_desc->hw.sar, sh_desc->hw.dar);
  240. /* Get the ld start address from ld_queue */
  241. dmae_set_reg(sh_chan, &sh_desc->hw);
  242. dmae_start(sh_chan);
  243. }
  244. static bool sh_dmae_channel_busy(struct shdma_chan *schan)
  245. {
  246. struct sh_dmae_chan *sh_chan = container_of(schan, struct sh_dmae_chan,
  247. shdma_chan);
  248. return dmae_is_busy(sh_chan);
  249. }
  250. static void sh_dmae_setup_xfer(struct shdma_chan *schan,
  251. int slave_id)
  252. {
  253. struct sh_dmae_chan *sh_chan = container_of(schan, struct sh_dmae_chan,
  254. shdma_chan);
  255. if (slave_id >= 0) {
  256. const struct sh_dmae_slave_config *cfg =
  257. sh_chan->config;
  258. dmae_set_dmars(sh_chan, cfg->mid_rid);
  259. dmae_set_chcr(sh_chan, cfg->chcr);
  260. } else {
  261. dmae_init(sh_chan);
  262. }
  263. }
  264. /*
  265. * Find a slave channel configuration from the contoller list by either a slave
  266. * ID in the non-DT case, or by a MID/RID value in the DT case
  267. */
  268. static const struct sh_dmae_slave_config *dmae_find_slave(
  269. struct sh_dmae_chan *sh_chan, int match)
  270. {
  271. struct sh_dmae_device *shdev = to_sh_dev(sh_chan);
  272. const struct sh_dmae_pdata *pdata = shdev->pdata;
  273. const struct sh_dmae_slave_config *cfg;
  274. int i;
  275. if (!sh_chan->shdma_chan.dev->of_node) {
  276. if (match >= SH_DMA_SLAVE_NUMBER)
  277. return NULL;
  278. for (i = 0, cfg = pdata->slave; i < pdata->slave_num; i++, cfg++)
  279. if (cfg->slave_id == match)
  280. return cfg;
  281. } else {
  282. for (i = 0, cfg = pdata->slave; i < pdata->slave_num; i++, cfg++)
  283. if (cfg->mid_rid == match) {
  284. sh_chan->shdma_chan.slave_id = i;
  285. return cfg;
  286. }
  287. }
  288. return NULL;
  289. }
  290. static int sh_dmae_set_slave(struct shdma_chan *schan,
  291. int slave_id, dma_addr_t slave_addr, bool try)
  292. {
  293. struct sh_dmae_chan *sh_chan = container_of(schan, struct sh_dmae_chan,
  294. shdma_chan);
  295. const struct sh_dmae_slave_config *cfg = dmae_find_slave(sh_chan, slave_id);
  296. if (!cfg)
  297. return -ENXIO;
  298. if (!try) {
  299. sh_chan->config = cfg;
  300. sh_chan->slave_addr = slave_addr ? : cfg->addr;
  301. }
  302. return 0;
  303. }
  304. static void dmae_halt(struct sh_dmae_chan *sh_chan)
  305. {
  306. struct sh_dmae_device *shdev = to_sh_dev(sh_chan);
  307. u32 chcr = chcr_read(sh_chan);
  308. chcr &= ~(CHCR_DE | CHCR_TE | shdev->chcr_ie_bit);
  309. chcr_write(sh_chan, chcr);
  310. }
  311. static int sh_dmae_desc_setup(struct shdma_chan *schan,
  312. struct shdma_desc *sdesc,
  313. dma_addr_t src, dma_addr_t dst, size_t *len)
  314. {
  315. struct sh_dmae_desc *sh_desc = container_of(sdesc,
  316. struct sh_dmae_desc, shdma_desc);
  317. if (*len > schan->max_xfer_len)
  318. *len = schan->max_xfer_len;
  319. sh_desc->hw.sar = src;
  320. sh_desc->hw.dar = dst;
  321. sh_desc->hw.tcr = *len;
  322. return 0;
  323. }
  324. static void sh_dmae_halt(struct shdma_chan *schan)
  325. {
  326. struct sh_dmae_chan *sh_chan = container_of(schan, struct sh_dmae_chan,
  327. shdma_chan);
  328. dmae_halt(sh_chan);
  329. }
  330. static bool sh_dmae_chan_irq(struct shdma_chan *schan, int irq)
  331. {
  332. struct sh_dmae_chan *sh_chan = container_of(schan, struct sh_dmae_chan,
  333. shdma_chan);
  334. if (!(chcr_read(sh_chan) & CHCR_TE))
  335. return false;
  336. /* DMA stop */
  337. dmae_halt(sh_chan);
  338. return true;
  339. }
  340. static size_t sh_dmae_get_partial(struct shdma_chan *schan,
  341. struct shdma_desc *sdesc)
  342. {
  343. struct sh_dmae_chan *sh_chan = container_of(schan, struct sh_dmae_chan,
  344. shdma_chan);
  345. struct sh_dmae_desc *sh_desc = container_of(sdesc,
  346. struct sh_dmae_desc, shdma_desc);
  347. return sh_desc->hw.tcr -
  348. (sh_dmae_readl(sh_chan, TCR) << sh_chan->xmit_shift);
  349. }
  350. /* Called from error IRQ or NMI */
  351. static bool sh_dmae_reset(struct sh_dmae_device *shdev)
  352. {
  353. bool ret;
  354. /* halt the dma controller */
  355. sh_dmae_ctl_stop(shdev);
  356. /* We cannot detect, which channel caused the error, have to reset all */
  357. ret = shdma_reset(&shdev->shdma_dev);
  358. sh_dmae_rst(shdev);
  359. return ret;
  360. }
  361. static irqreturn_t sh_dmae_err(int irq, void *data)
  362. {
  363. struct sh_dmae_device *shdev = data;
  364. if (!(dmaor_read(shdev) & DMAOR_AE))
  365. return IRQ_NONE;
  366. sh_dmae_reset(shdev);
  367. return IRQ_HANDLED;
  368. }
  369. static bool sh_dmae_desc_completed(struct shdma_chan *schan,
  370. struct shdma_desc *sdesc)
  371. {
  372. struct sh_dmae_chan *sh_chan = container_of(schan,
  373. struct sh_dmae_chan, shdma_chan);
  374. struct sh_dmae_desc *sh_desc = container_of(sdesc,
  375. struct sh_dmae_desc, shdma_desc);
  376. u32 sar_buf = sh_dmae_readl(sh_chan, SAR);
  377. u32 dar_buf = sh_dmae_readl(sh_chan, DAR);
  378. return (sdesc->direction == DMA_DEV_TO_MEM &&
  379. (sh_desc->hw.dar + sh_desc->hw.tcr) == dar_buf) ||
  380. (sdesc->direction != DMA_DEV_TO_MEM &&
  381. (sh_desc->hw.sar + sh_desc->hw.tcr) == sar_buf);
  382. }
  383. static bool sh_dmae_nmi_notify(struct sh_dmae_device *shdev)
  384. {
  385. /* Fast path out if NMIF is not asserted for this controller */
  386. if ((dmaor_read(shdev) & DMAOR_NMIF) == 0)
  387. return false;
  388. return sh_dmae_reset(shdev);
  389. }
  390. static int sh_dmae_nmi_handler(struct notifier_block *self,
  391. unsigned long cmd, void *data)
  392. {
  393. struct sh_dmae_device *shdev;
  394. int ret = NOTIFY_DONE;
  395. bool triggered;
  396. /*
  397. * Only concern ourselves with NMI events.
  398. *
  399. * Normally we would check the die chain value, but as this needs
  400. * to be architecture independent, check for NMI context instead.
  401. */
  402. if (!in_nmi())
  403. return NOTIFY_DONE;
  404. rcu_read_lock();
  405. list_for_each_entry_rcu(shdev, &sh_dmae_devices, node) {
  406. /*
  407. * Only stop if one of the controllers has NMIF asserted,
  408. * we do not want to interfere with regular address error
  409. * handling or NMI events that don't concern the DMACs.
  410. */
  411. triggered = sh_dmae_nmi_notify(shdev);
  412. if (triggered == true)
  413. ret = NOTIFY_OK;
  414. }
  415. rcu_read_unlock();
  416. return ret;
  417. }
  418. static struct notifier_block sh_dmae_nmi_notifier __read_mostly = {
  419. .notifier_call = sh_dmae_nmi_handler,
  420. /* Run before NMI debug handler and KGDB */
  421. .priority = 1,
  422. };
  423. static int sh_dmae_chan_probe(struct sh_dmae_device *shdev, int id,
  424. int irq, unsigned long flags)
  425. {
  426. const struct sh_dmae_channel *chan_pdata = &shdev->pdata->channel[id];
  427. struct shdma_dev *sdev = &shdev->shdma_dev;
  428. struct platform_device *pdev = to_platform_device(sdev->dma_dev.dev);
  429. struct sh_dmae_chan *sh_chan;
  430. struct shdma_chan *schan;
  431. int err;
  432. sh_chan = devm_kzalloc(sdev->dma_dev.dev, sizeof(struct sh_dmae_chan),
  433. GFP_KERNEL);
  434. if (!sh_chan) {
  435. dev_err(sdev->dma_dev.dev,
  436. "No free memory for allocating dma channels!\n");
  437. return -ENOMEM;
  438. }
  439. schan = &sh_chan->shdma_chan;
  440. schan->max_xfer_len = SH_DMA_TCR_MAX + 1;
  441. shdma_chan_probe(sdev, schan, id);
  442. sh_chan->base = shdev->chan_reg + chan_pdata->offset;
  443. /* set up channel irq */
  444. if (pdev->id >= 0)
  445. snprintf(sh_chan->dev_id, sizeof(sh_chan->dev_id),
  446. "sh-dmae%d.%d", pdev->id, id);
  447. else
  448. snprintf(sh_chan->dev_id, sizeof(sh_chan->dev_id),
  449. "sh-dma%d", id);
  450. err = shdma_request_irq(schan, irq, flags, sh_chan->dev_id);
  451. if (err) {
  452. dev_err(sdev->dma_dev.dev,
  453. "DMA channel %d request_irq error %d\n",
  454. id, err);
  455. goto err_no_irq;
  456. }
  457. shdev->chan[id] = sh_chan;
  458. return 0;
  459. err_no_irq:
  460. /* remove from dmaengine device node */
  461. shdma_chan_remove(schan);
  462. return err;
  463. }
  464. static void sh_dmae_chan_remove(struct sh_dmae_device *shdev)
  465. {
  466. struct dma_device *dma_dev = &shdev->shdma_dev.dma_dev;
  467. struct shdma_chan *schan;
  468. int i;
  469. shdma_for_each_chan(schan, &shdev->shdma_dev, i) {
  470. BUG_ON(!schan);
  471. shdma_chan_remove(schan);
  472. }
  473. dma_dev->chancnt = 0;
  474. }
  475. static void sh_dmae_shutdown(struct platform_device *pdev)
  476. {
  477. struct sh_dmae_device *shdev = platform_get_drvdata(pdev);
  478. sh_dmae_ctl_stop(shdev);
  479. }
  480. static int sh_dmae_runtime_suspend(struct device *dev)
  481. {
  482. return 0;
  483. }
  484. static int sh_dmae_runtime_resume(struct device *dev)
  485. {
  486. struct sh_dmae_device *shdev = dev_get_drvdata(dev);
  487. return sh_dmae_rst(shdev);
  488. }
  489. #ifdef CONFIG_PM
  490. static int sh_dmae_suspend(struct device *dev)
  491. {
  492. return 0;
  493. }
  494. static int sh_dmae_resume(struct device *dev)
  495. {
  496. struct sh_dmae_device *shdev = dev_get_drvdata(dev);
  497. int i, ret;
  498. ret = sh_dmae_rst(shdev);
  499. if (ret < 0)
  500. dev_err(dev, "Failed to reset!\n");
  501. for (i = 0; i < shdev->pdata->channel_num; i++) {
  502. struct sh_dmae_chan *sh_chan = shdev->chan[i];
  503. if (!sh_chan->shdma_chan.desc_num)
  504. continue;
  505. if (sh_chan->shdma_chan.slave_id >= 0) {
  506. const struct sh_dmae_slave_config *cfg = sh_chan->config;
  507. dmae_set_dmars(sh_chan, cfg->mid_rid);
  508. dmae_set_chcr(sh_chan, cfg->chcr);
  509. } else {
  510. dmae_init(sh_chan);
  511. }
  512. }
  513. return 0;
  514. }
  515. #else
  516. #define sh_dmae_suspend NULL
  517. #define sh_dmae_resume NULL
  518. #endif
  519. const struct dev_pm_ops sh_dmae_pm = {
  520. .suspend = sh_dmae_suspend,
  521. .resume = sh_dmae_resume,
  522. .runtime_suspend = sh_dmae_runtime_suspend,
  523. .runtime_resume = sh_dmae_runtime_resume,
  524. };
  525. static dma_addr_t sh_dmae_slave_addr(struct shdma_chan *schan)
  526. {
  527. struct sh_dmae_chan *sh_chan = container_of(schan,
  528. struct sh_dmae_chan, shdma_chan);
  529. /*
  530. * Implicit BUG_ON(!sh_chan->config)
  531. * This is an exclusive slave DMA operation, may only be called after a
  532. * successful slave configuration.
  533. */
  534. return sh_chan->slave_addr;
  535. }
  536. static struct shdma_desc *sh_dmae_embedded_desc(void *buf, int i)
  537. {
  538. return &((struct sh_dmae_desc *)buf)[i].shdma_desc;
  539. }
  540. static const struct shdma_ops sh_dmae_shdma_ops = {
  541. .desc_completed = sh_dmae_desc_completed,
  542. .halt_channel = sh_dmae_halt,
  543. .channel_busy = sh_dmae_channel_busy,
  544. .slave_addr = sh_dmae_slave_addr,
  545. .desc_setup = sh_dmae_desc_setup,
  546. .set_slave = sh_dmae_set_slave,
  547. .setup_xfer = sh_dmae_setup_xfer,
  548. .start_xfer = sh_dmae_start_xfer,
  549. .embedded_desc = sh_dmae_embedded_desc,
  550. .chan_irq = sh_dmae_chan_irq,
  551. .get_partial = sh_dmae_get_partial,
  552. };
  553. static const struct of_device_id sh_dmae_of_match[] = {
  554. {.compatible = "renesas,shdma-r8a73a4", .data = r8a73a4_shdma_devid,},
  555. {}
  556. };
  557. MODULE_DEVICE_TABLE(of, sh_dmae_of_match);
  558. static int sh_dmae_probe(struct platform_device *pdev)
  559. {
  560. const struct sh_dmae_pdata *pdata;
  561. unsigned long irqflags = IRQF_DISABLED,
  562. chan_flag[SH_DMAE_MAX_CHANNELS] = {};
  563. int errirq, chan_irq[SH_DMAE_MAX_CHANNELS];
  564. int err, i, irq_cnt = 0, irqres = 0, irq_cap = 0;
  565. struct sh_dmae_device *shdev;
  566. struct dma_device *dma_dev;
  567. struct resource *chan, *dmars, *errirq_res, *chanirq_res;
  568. if (pdev->dev.of_node)
  569. pdata = of_match_device(sh_dmae_of_match, &pdev->dev)->data;
  570. else
  571. pdata = dev_get_platdata(&pdev->dev);
  572. /* get platform data */
  573. if (!pdata || !pdata->channel_num)
  574. return -ENODEV;
  575. chan = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  576. /* DMARS area is optional */
  577. dmars = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  578. /*
  579. * IRQ resources:
  580. * 1. there always must be at least one IRQ IO-resource. On SH4 it is
  581. * the error IRQ, in which case it is the only IRQ in this resource:
  582. * start == end. If it is the only IRQ resource, all channels also
  583. * use the same IRQ.
  584. * 2. DMA channel IRQ resources can be specified one per resource or in
  585. * ranges (start != end)
  586. * 3. iff all events (channels and, optionally, error) on this
  587. * controller use the same IRQ, only one IRQ resource can be
  588. * specified, otherwise there must be one IRQ per channel, even if
  589. * some of them are equal
  590. * 4. if all IRQs on this controller are equal or if some specific IRQs
  591. * specify IORESOURCE_IRQ_SHAREABLE in their resources, they will be
  592. * requested with the IRQF_SHARED flag
  593. */
  594. errirq_res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
  595. if (!chan || !errirq_res)
  596. return -ENODEV;
  597. shdev = devm_kzalloc(&pdev->dev, sizeof(struct sh_dmae_device),
  598. GFP_KERNEL);
  599. if (!shdev) {
  600. dev_err(&pdev->dev, "Not enough memory\n");
  601. return -ENOMEM;
  602. }
  603. dma_dev = &shdev->shdma_dev.dma_dev;
  604. shdev->chan_reg = devm_ioremap_resource(&pdev->dev, chan);
  605. if (IS_ERR(shdev->chan_reg))
  606. return PTR_ERR(shdev->chan_reg);
  607. if (dmars) {
  608. shdev->dmars = devm_ioremap_resource(&pdev->dev, dmars);
  609. if (IS_ERR(shdev->dmars))
  610. return PTR_ERR(shdev->dmars);
  611. }
  612. if (!pdata->slave_only)
  613. dma_cap_set(DMA_MEMCPY, dma_dev->cap_mask);
  614. if (pdata->slave && pdata->slave_num)
  615. dma_cap_set(DMA_SLAVE, dma_dev->cap_mask);
  616. /* Default transfer size of 32 bytes requires 32-byte alignment */
  617. dma_dev->copy_align = LOG2_DEFAULT_XFER_SIZE;
  618. shdev->shdma_dev.ops = &sh_dmae_shdma_ops;
  619. shdev->shdma_dev.desc_size = sizeof(struct sh_dmae_desc);
  620. err = shdma_init(&pdev->dev, &shdev->shdma_dev,
  621. pdata->channel_num);
  622. if (err < 0)
  623. goto eshdma;
  624. /* platform data */
  625. shdev->pdata = pdata;
  626. if (pdata->chcr_offset)
  627. shdev->chcr_offset = pdata->chcr_offset;
  628. else
  629. shdev->chcr_offset = CHCR;
  630. if (pdata->chcr_ie_bit)
  631. shdev->chcr_ie_bit = pdata->chcr_ie_bit;
  632. else
  633. shdev->chcr_ie_bit = CHCR_IE;
  634. platform_set_drvdata(pdev, shdev);
  635. pm_runtime_enable(&pdev->dev);
  636. err = pm_runtime_get_sync(&pdev->dev);
  637. if (err < 0)
  638. dev_err(&pdev->dev, "%s(): GET = %d\n", __func__, err);
  639. spin_lock_irq(&sh_dmae_lock);
  640. list_add_tail_rcu(&shdev->node, &sh_dmae_devices);
  641. spin_unlock_irq(&sh_dmae_lock);
  642. /* reset dma controller - only needed as a test */
  643. err = sh_dmae_rst(shdev);
  644. if (err)
  645. goto rst_err;
  646. #if defined(CONFIG_CPU_SH4) || defined(CONFIG_ARCH_SHMOBILE)
  647. chanirq_res = platform_get_resource(pdev, IORESOURCE_IRQ, 1);
  648. if (!chanirq_res)
  649. chanirq_res = errirq_res;
  650. else
  651. irqres++;
  652. if (chanirq_res == errirq_res ||
  653. (errirq_res->flags & IORESOURCE_BITS) == IORESOURCE_IRQ_SHAREABLE)
  654. irqflags = IRQF_SHARED;
  655. errirq = errirq_res->start;
  656. err = devm_request_irq(&pdev->dev, errirq, sh_dmae_err, irqflags,
  657. "DMAC Address Error", shdev);
  658. if (err) {
  659. dev_err(&pdev->dev,
  660. "DMA failed requesting irq #%d, error %d\n",
  661. errirq, err);
  662. goto eirq_err;
  663. }
  664. #else
  665. chanirq_res = errirq_res;
  666. #endif /* CONFIG_CPU_SH4 || CONFIG_ARCH_SHMOBILE */
  667. if (chanirq_res->start == chanirq_res->end &&
  668. !platform_get_resource(pdev, IORESOURCE_IRQ, 1)) {
  669. /* Special case - all multiplexed */
  670. for (; irq_cnt < pdata->channel_num; irq_cnt++) {
  671. if (irq_cnt < SH_DMAE_MAX_CHANNELS) {
  672. chan_irq[irq_cnt] = chanirq_res->start;
  673. chan_flag[irq_cnt] = IRQF_SHARED;
  674. } else {
  675. irq_cap = 1;
  676. break;
  677. }
  678. }
  679. } else {
  680. do {
  681. for (i = chanirq_res->start; i <= chanirq_res->end; i++) {
  682. if (irq_cnt >= SH_DMAE_MAX_CHANNELS) {
  683. irq_cap = 1;
  684. break;
  685. }
  686. if ((errirq_res->flags & IORESOURCE_BITS) ==
  687. IORESOURCE_IRQ_SHAREABLE)
  688. chan_flag[irq_cnt] = IRQF_SHARED;
  689. else
  690. chan_flag[irq_cnt] = IRQF_DISABLED;
  691. dev_dbg(&pdev->dev,
  692. "Found IRQ %d for channel %d\n",
  693. i, irq_cnt);
  694. chan_irq[irq_cnt++] = i;
  695. }
  696. if (irq_cnt >= SH_DMAE_MAX_CHANNELS)
  697. break;
  698. chanirq_res = platform_get_resource(pdev,
  699. IORESOURCE_IRQ, ++irqres);
  700. } while (irq_cnt < pdata->channel_num && chanirq_res);
  701. }
  702. /* Create DMA Channel */
  703. for (i = 0; i < irq_cnt; i++) {
  704. err = sh_dmae_chan_probe(shdev, i, chan_irq[i], chan_flag[i]);
  705. if (err)
  706. goto chan_probe_err;
  707. }
  708. if (irq_cap)
  709. dev_notice(&pdev->dev, "Attempting to register %d DMA "
  710. "channels when a maximum of %d are supported.\n",
  711. pdata->channel_num, SH_DMAE_MAX_CHANNELS);
  712. pm_runtime_put(&pdev->dev);
  713. err = dma_async_device_register(&shdev->shdma_dev.dma_dev);
  714. if (err < 0)
  715. goto edmadevreg;
  716. return err;
  717. edmadevreg:
  718. pm_runtime_get(&pdev->dev);
  719. chan_probe_err:
  720. sh_dmae_chan_remove(shdev);
  721. #if defined(CONFIG_CPU_SH4) || defined(CONFIG_ARCH_SHMOBILE)
  722. eirq_err:
  723. #endif
  724. rst_err:
  725. spin_lock_irq(&sh_dmae_lock);
  726. list_del_rcu(&shdev->node);
  727. spin_unlock_irq(&sh_dmae_lock);
  728. pm_runtime_put(&pdev->dev);
  729. pm_runtime_disable(&pdev->dev);
  730. shdma_cleanup(&shdev->shdma_dev);
  731. eshdma:
  732. synchronize_rcu();
  733. return err;
  734. }
  735. static int sh_dmae_remove(struct platform_device *pdev)
  736. {
  737. struct sh_dmae_device *shdev = platform_get_drvdata(pdev);
  738. struct dma_device *dma_dev = &shdev->shdma_dev.dma_dev;
  739. dma_async_device_unregister(dma_dev);
  740. spin_lock_irq(&sh_dmae_lock);
  741. list_del_rcu(&shdev->node);
  742. spin_unlock_irq(&sh_dmae_lock);
  743. pm_runtime_disable(&pdev->dev);
  744. sh_dmae_chan_remove(shdev);
  745. shdma_cleanup(&shdev->shdma_dev);
  746. synchronize_rcu();
  747. return 0;
  748. }
  749. static struct platform_driver sh_dmae_driver = {
  750. .driver = {
  751. .owner = THIS_MODULE,
  752. .pm = &sh_dmae_pm,
  753. .name = SH_DMAE_DRV_NAME,
  754. .of_match_table = sh_dmae_of_match,
  755. },
  756. .remove = sh_dmae_remove,
  757. .shutdown = sh_dmae_shutdown,
  758. };
  759. static int __init sh_dmae_init(void)
  760. {
  761. /* Wire up NMI handling */
  762. int err = register_die_notifier(&sh_dmae_nmi_notifier);
  763. if (err)
  764. return err;
  765. return platform_driver_probe(&sh_dmae_driver, sh_dmae_probe);
  766. }
  767. module_init(sh_dmae_init);
  768. static void __exit sh_dmae_exit(void)
  769. {
  770. platform_driver_unregister(&sh_dmae_driver);
  771. unregister_die_notifier(&sh_dmae_nmi_notifier);
  772. }
  773. module_exit(sh_dmae_exit);
  774. MODULE_AUTHOR("Nobuhiro Iwamatsu <iwamatsu.nobuhiro@renesas.com>");
  775. MODULE_DESCRIPTION("Renesas SH DMA Engine driver");
  776. MODULE_LICENSE("GPL");
  777. MODULE_ALIAS("platform:" SH_DMAE_DRV_NAME);