rcar-dmac.c 50 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886
  1. /*
  2. * Renesas R-Car Gen2 DMA Controller Driver
  3. *
  4. * Copyright (C) 2014 Renesas Electronics Inc.
  5. *
  6. * Author: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
  7. *
  8. * This is free software; you can redistribute it and/or modify
  9. * it under the terms of version 2 of the GNU General Public License as
  10. * published by the Free Software Foundation.
  11. */
  12. #include <linux/dma-mapping.h>
  13. #include <linux/dmaengine.h>
  14. #include <linux/interrupt.h>
  15. #include <linux/list.h>
  16. #include <linux/module.h>
  17. #include <linux/mutex.h>
  18. #include <linux/of.h>
  19. #include <linux/of_dma.h>
  20. #include <linux/of_platform.h>
  21. #include <linux/platform_device.h>
  22. #include <linux/pm_runtime.h>
  23. #include <linux/slab.h>
  24. #include <linux/spinlock.h>
  25. #include "../dmaengine.h"
  26. /*
  27. * struct rcar_dmac_xfer_chunk - Descriptor for a hardware transfer
  28. * @node: entry in the parent's chunks list
  29. * @src_addr: device source address
  30. * @dst_addr: device destination address
  31. * @size: transfer size in bytes
  32. */
  33. struct rcar_dmac_xfer_chunk {
  34. struct list_head node;
  35. dma_addr_t src_addr;
  36. dma_addr_t dst_addr;
  37. u32 size;
  38. };
  39. /*
  40. * struct rcar_dmac_hw_desc - Hardware descriptor for a transfer chunk
  41. * @sar: value of the SAR register (source address)
  42. * @dar: value of the DAR register (destination address)
  43. * @tcr: value of the TCR register (transfer count)
  44. */
  45. struct rcar_dmac_hw_desc {
  46. u32 sar;
  47. u32 dar;
  48. u32 tcr;
  49. u32 reserved;
  50. } __attribute__((__packed__));
  51. /*
  52. * struct rcar_dmac_desc - R-Car Gen2 DMA Transfer Descriptor
  53. * @async_tx: base DMA asynchronous transaction descriptor
  54. * @direction: direction of the DMA transfer
  55. * @xfer_shift: log2 of the transfer size
  56. * @chcr: value of the channel configuration register for this transfer
  57. * @node: entry in the channel's descriptors lists
  58. * @chunks: list of transfer chunks for this transfer
  59. * @running: the transfer chunk being currently processed
  60. * @nchunks: number of transfer chunks for this transfer
  61. * @hwdescs.use: whether the transfer descriptor uses hardware descriptors
  62. * @hwdescs.mem: hardware descriptors memory for the transfer
  63. * @hwdescs.dma: device address of the hardware descriptors memory
  64. * @hwdescs.size: size of the hardware descriptors in bytes
  65. * @size: transfer size in bytes
  66. * @cyclic: when set indicates that the DMA transfer is cyclic
  67. */
  68. struct rcar_dmac_desc {
  69. struct dma_async_tx_descriptor async_tx;
  70. enum dma_transfer_direction direction;
  71. unsigned int xfer_shift;
  72. u32 chcr;
  73. struct list_head node;
  74. struct list_head chunks;
  75. struct rcar_dmac_xfer_chunk *running;
  76. unsigned int nchunks;
  77. struct {
  78. bool use;
  79. struct rcar_dmac_hw_desc *mem;
  80. dma_addr_t dma;
  81. size_t size;
  82. } hwdescs;
  83. unsigned int size;
  84. bool cyclic;
  85. };
  86. #define to_rcar_dmac_desc(d) container_of(d, struct rcar_dmac_desc, async_tx)
  87. /*
  88. * struct rcar_dmac_desc_page - One page worth of descriptors
  89. * @node: entry in the channel's pages list
  90. * @descs: array of DMA descriptors
  91. * @chunks: array of transfer chunk descriptors
  92. */
  93. struct rcar_dmac_desc_page {
  94. struct list_head node;
  95. union {
  96. struct rcar_dmac_desc descs[0];
  97. struct rcar_dmac_xfer_chunk chunks[0];
  98. };
  99. };
  100. #define RCAR_DMAC_DESCS_PER_PAGE \
  101. ((PAGE_SIZE - offsetof(struct rcar_dmac_desc_page, descs)) / \
  102. sizeof(struct rcar_dmac_desc))
  103. #define RCAR_DMAC_XFER_CHUNKS_PER_PAGE \
  104. ((PAGE_SIZE - offsetof(struct rcar_dmac_desc_page, chunks)) / \
  105. sizeof(struct rcar_dmac_xfer_chunk))
  106. /*
  107. * struct rcar_dmac_chan_slave - Slave configuration
  108. * @slave_addr: slave memory address
  109. * @xfer_size: size (in bytes) of hardware transfers
  110. */
  111. struct rcar_dmac_chan_slave {
  112. phys_addr_t slave_addr;
  113. unsigned int xfer_size;
  114. };
  115. /*
  116. * struct rcar_dmac_chan_map - Map of slave device phys to dma address
  117. * @addr: slave dma address
  118. * @dir: direction of mapping
  119. * @slave: slave configuration that is mapped
  120. */
  121. struct rcar_dmac_chan_map {
  122. dma_addr_t addr;
  123. enum dma_data_direction dir;
  124. struct rcar_dmac_chan_slave slave;
  125. };
  126. /*
  127. * struct rcar_dmac_chan - R-Car Gen2 DMA Controller Channel
  128. * @chan: base DMA channel object
  129. * @iomem: channel I/O memory base
  130. * @index: index of this channel in the controller
  131. * @src: slave memory address and size on the source side
  132. * @dst: slave memory address and size on the destination side
  133. * @mid_rid: hardware MID/RID for the DMA client using this channel
  134. * @lock: protects the channel CHCR register and the desc members
  135. * @desc.free: list of free descriptors
  136. * @desc.pending: list of pending descriptors (submitted with tx_submit)
  137. * @desc.active: list of active descriptors (activated with issue_pending)
  138. * @desc.done: list of completed descriptors
  139. * @desc.wait: list of descriptors waiting for an ack
  140. * @desc.running: the descriptor being processed (a member of the active list)
  141. * @desc.chunks_free: list of free transfer chunk descriptors
  142. * @desc.pages: list of pages used by allocated descriptors
  143. */
  144. struct rcar_dmac_chan {
  145. struct dma_chan chan;
  146. void __iomem *iomem;
  147. unsigned int index;
  148. struct rcar_dmac_chan_slave src;
  149. struct rcar_dmac_chan_slave dst;
  150. struct rcar_dmac_chan_map map;
  151. int mid_rid;
  152. spinlock_t lock;
  153. struct {
  154. struct list_head free;
  155. struct list_head pending;
  156. struct list_head active;
  157. struct list_head done;
  158. struct list_head wait;
  159. struct rcar_dmac_desc *running;
  160. struct list_head chunks_free;
  161. struct list_head pages;
  162. } desc;
  163. };
  164. #define to_rcar_dmac_chan(c) container_of(c, struct rcar_dmac_chan, chan)
  165. /*
  166. * struct rcar_dmac - R-Car Gen2 DMA Controller
  167. * @engine: base DMA engine object
  168. * @dev: the hardware device
  169. * @iomem: remapped I/O memory base
  170. * @n_channels: number of available channels
  171. * @channels: array of DMAC channels
  172. * @modules: bitmask of client modules in use
  173. */
  174. struct rcar_dmac {
  175. struct dma_device engine;
  176. struct device *dev;
  177. void __iomem *iomem;
  178. unsigned int n_channels;
  179. struct rcar_dmac_chan *channels;
  180. DECLARE_BITMAP(modules, 256);
  181. };
  182. #define to_rcar_dmac(d) container_of(d, struct rcar_dmac, engine)
  183. /* -----------------------------------------------------------------------------
  184. * Registers
  185. */
  186. #define RCAR_DMAC_CHAN_OFFSET(i) (0x8000 + 0x80 * (i))
  187. #define RCAR_DMAISTA 0x0020
  188. #define RCAR_DMASEC 0x0030
  189. #define RCAR_DMAOR 0x0060
  190. #define RCAR_DMAOR_PRI_FIXED (0 << 8)
  191. #define RCAR_DMAOR_PRI_ROUND_ROBIN (3 << 8)
  192. #define RCAR_DMAOR_AE (1 << 2)
  193. #define RCAR_DMAOR_DME (1 << 0)
  194. #define RCAR_DMACHCLR 0x0080
  195. #define RCAR_DMADPSEC 0x00a0
  196. #define RCAR_DMASAR 0x0000
  197. #define RCAR_DMADAR 0x0004
  198. #define RCAR_DMATCR 0x0008
  199. #define RCAR_DMATCR_MASK 0x00ffffff
  200. #define RCAR_DMATSR 0x0028
  201. #define RCAR_DMACHCR 0x000c
  202. #define RCAR_DMACHCR_CAE (1 << 31)
  203. #define RCAR_DMACHCR_CAIE (1 << 30)
  204. #define RCAR_DMACHCR_DPM_DISABLED (0 << 28)
  205. #define RCAR_DMACHCR_DPM_ENABLED (1 << 28)
  206. #define RCAR_DMACHCR_DPM_REPEAT (2 << 28)
  207. #define RCAR_DMACHCR_DPM_INFINITE (3 << 28)
  208. #define RCAR_DMACHCR_RPT_SAR (1 << 27)
  209. #define RCAR_DMACHCR_RPT_DAR (1 << 26)
  210. #define RCAR_DMACHCR_RPT_TCR (1 << 25)
  211. #define RCAR_DMACHCR_DPB (1 << 22)
  212. #define RCAR_DMACHCR_DSE (1 << 19)
  213. #define RCAR_DMACHCR_DSIE (1 << 18)
  214. #define RCAR_DMACHCR_TS_1B ((0 << 20) | (0 << 3))
  215. #define RCAR_DMACHCR_TS_2B ((0 << 20) | (1 << 3))
  216. #define RCAR_DMACHCR_TS_4B ((0 << 20) | (2 << 3))
  217. #define RCAR_DMACHCR_TS_16B ((0 << 20) | (3 << 3))
  218. #define RCAR_DMACHCR_TS_32B ((1 << 20) | (0 << 3))
  219. #define RCAR_DMACHCR_TS_64B ((1 << 20) | (1 << 3))
  220. #define RCAR_DMACHCR_TS_8B ((1 << 20) | (3 << 3))
  221. #define RCAR_DMACHCR_DM_FIXED (0 << 14)
  222. #define RCAR_DMACHCR_DM_INC (1 << 14)
  223. #define RCAR_DMACHCR_DM_DEC (2 << 14)
  224. #define RCAR_DMACHCR_SM_FIXED (0 << 12)
  225. #define RCAR_DMACHCR_SM_INC (1 << 12)
  226. #define RCAR_DMACHCR_SM_DEC (2 << 12)
  227. #define RCAR_DMACHCR_RS_AUTO (4 << 8)
  228. #define RCAR_DMACHCR_RS_DMARS (8 << 8)
  229. #define RCAR_DMACHCR_IE (1 << 2)
  230. #define RCAR_DMACHCR_TE (1 << 1)
  231. #define RCAR_DMACHCR_DE (1 << 0)
  232. #define RCAR_DMATCRB 0x0018
  233. #define RCAR_DMATSRB 0x0038
  234. #define RCAR_DMACHCRB 0x001c
  235. #define RCAR_DMACHCRB_DCNT(n) ((n) << 24)
  236. #define RCAR_DMACHCRB_DPTR_MASK (0xff << 16)
  237. #define RCAR_DMACHCRB_DPTR_SHIFT 16
  238. #define RCAR_DMACHCRB_DRST (1 << 15)
  239. #define RCAR_DMACHCRB_DTS (1 << 8)
  240. #define RCAR_DMACHCRB_SLM_NORMAL (0 << 4)
  241. #define RCAR_DMACHCRB_SLM_CLK(n) ((8 | (n)) << 4)
  242. #define RCAR_DMACHCRB_PRI(n) ((n) << 0)
  243. #define RCAR_DMARS 0x0040
  244. #define RCAR_DMABUFCR 0x0048
  245. #define RCAR_DMABUFCR_MBU(n) ((n) << 16)
  246. #define RCAR_DMABUFCR_ULB(n) ((n) << 0)
  247. #define RCAR_DMADPBASE 0x0050
  248. #define RCAR_DMADPBASE_MASK 0xfffffff0
  249. #define RCAR_DMADPBASE_SEL (1 << 0)
  250. #define RCAR_DMADPCR 0x0054
  251. #define RCAR_DMADPCR_DIPT(n) ((n) << 24)
  252. #define RCAR_DMAFIXSAR 0x0010
  253. #define RCAR_DMAFIXDAR 0x0014
  254. #define RCAR_DMAFIXDPBASE 0x0060
  255. /* Hardcode the MEMCPY transfer size to 4 bytes. */
  256. #define RCAR_DMAC_MEMCPY_XFER_SIZE 4
  257. /* -----------------------------------------------------------------------------
  258. * Device access
  259. */
  260. static void rcar_dmac_write(struct rcar_dmac *dmac, u32 reg, u32 data)
  261. {
  262. if (reg == RCAR_DMAOR)
  263. writew(data, dmac->iomem + reg);
  264. else
  265. writel(data, dmac->iomem + reg);
  266. }
  267. static u32 rcar_dmac_read(struct rcar_dmac *dmac, u32 reg)
  268. {
  269. if (reg == RCAR_DMAOR)
  270. return readw(dmac->iomem + reg);
  271. else
  272. return readl(dmac->iomem + reg);
  273. }
  274. static u32 rcar_dmac_chan_read(struct rcar_dmac_chan *chan, u32 reg)
  275. {
  276. if (reg == RCAR_DMARS)
  277. return readw(chan->iomem + reg);
  278. else
  279. return readl(chan->iomem + reg);
  280. }
  281. static void rcar_dmac_chan_write(struct rcar_dmac_chan *chan, u32 reg, u32 data)
  282. {
  283. if (reg == RCAR_DMARS)
  284. writew(data, chan->iomem + reg);
  285. else
  286. writel(data, chan->iomem + reg);
  287. }
  288. /* -----------------------------------------------------------------------------
  289. * Initialization and configuration
  290. */
  291. static bool rcar_dmac_chan_is_busy(struct rcar_dmac_chan *chan)
  292. {
  293. u32 chcr = rcar_dmac_chan_read(chan, RCAR_DMACHCR);
  294. return !!(chcr & (RCAR_DMACHCR_DE | RCAR_DMACHCR_TE));
  295. }
  296. static void rcar_dmac_chan_start_xfer(struct rcar_dmac_chan *chan)
  297. {
  298. struct rcar_dmac_desc *desc = chan->desc.running;
  299. u32 chcr = desc->chcr;
  300. WARN_ON_ONCE(rcar_dmac_chan_is_busy(chan));
  301. if (chan->mid_rid >= 0)
  302. rcar_dmac_chan_write(chan, RCAR_DMARS, chan->mid_rid);
  303. if (desc->hwdescs.use) {
  304. struct rcar_dmac_xfer_chunk *chunk;
  305. dev_dbg(chan->chan.device->dev,
  306. "chan%u: queue desc %p: %u@%pad\n",
  307. chan->index, desc, desc->nchunks, &desc->hwdescs.dma);
  308. #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
  309. rcar_dmac_chan_write(chan, RCAR_DMAFIXDPBASE,
  310. desc->hwdescs.dma >> 32);
  311. #endif
  312. rcar_dmac_chan_write(chan, RCAR_DMADPBASE,
  313. (desc->hwdescs.dma & 0xfffffff0) |
  314. RCAR_DMADPBASE_SEL);
  315. rcar_dmac_chan_write(chan, RCAR_DMACHCRB,
  316. RCAR_DMACHCRB_DCNT(desc->nchunks - 1) |
  317. RCAR_DMACHCRB_DRST);
  318. /*
  319. * Errata: When descriptor memory is accessed through an IOMMU
  320. * the DMADAR register isn't initialized automatically from the
  321. * first descriptor at beginning of transfer by the DMAC like it
  322. * should. Initialize it manually with the destination address
  323. * of the first chunk.
  324. */
  325. chunk = list_first_entry(&desc->chunks,
  326. struct rcar_dmac_xfer_chunk, node);
  327. rcar_dmac_chan_write(chan, RCAR_DMADAR,
  328. chunk->dst_addr & 0xffffffff);
  329. /*
  330. * Program the descriptor stage interrupt to occur after the end
  331. * of the first stage.
  332. */
  333. rcar_dmac_chan_write(chan, RCAR_DMADPCR, RCAR_DMADPCR_DIPT(1));
  334. chcr |= RCAR_DMACHCR_RPT_SAR | RCAR_DMACHCR_RPT_DAR
  335. | RCAR_DMACHCR_RPT_TCR | RCAR_DMACHCR_DPB;
  336. /*
  337. * If the descriptor isn't cyclic enable normal descriptor mode
  338. * and the transfer completion interrupt.
  339. */
  340. if (!desc->cyclic)
  341. chcr |= RCAR_DMACHCR_DPM_ENABLED | RCAR_DMACHCR_IE;
  342. /*
  343. * If the descriptor is cyclic and has a callback enable the
  344. * descriptor stage interrupt in infinite repeat mode.
  345. */
  346. else if (desc->async_tx.callback)
  347. chcr |= RCAR_DMACHCR_DPM_INFINITE | RCAR_DMACHCR_DSIE;
  348. /*
  349. * Otherwise just select infinite repeat mode without any
  350. * interrupt.
  351. */
  352. else
  353. chcr |= RCAR_DMACHCR_DPM_INFINITE;
  354. } else {
  355. struct rcar_dmac_xfer_chunk *chunk = desc->running;
  356. dev_dbg(chan->chan.device->dev,
  357. "chan%u: queue chunk %p: %u@%pad -> %pad\n",
  358. chan->index, chunk, chunk->size, &chunk->src_addr,
  359. &chunk->dst_addr);
  360. #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
  361. rcar_dmac_chan_write(chan, RCAR_DMAFIXSAR,
  362. chunk->src_addr >> 32);
  363. rcar_dmac_chan_write(chan, RCAR_DMAFIXDAR,
  364. chunk->dst_addr >> 32);
  365. #endif
  366. rcar_dmac_chan_write(chan, RCAR_DMASAR,
  367. chunk->src_addr & 0xffffffff);
  368. rcar_dmac_chan_write(chan, RCAR_DMADAR,
  369. chunk->dst_addr & 0xffffffff);
  370. rcar_dmac_chan_write(chan, RCAR_DMATCR,
  371. chunk->size >> desc->xfer_shift);
  372. chcr |= RCAR_DMACHCR_DPM_DISABLED | RCAR_DMACHCR_IE;
  373. }
  374. rcar_dmac_chan_write(chan, RCAR_DMACHCR, chcr | RCAR_DMACHCR_DE);
  375. }
  376. static int rcar_dmac_init(struct rcar_dmac *dmac)
  377. {
  378. u16 dmaor;
  379. /* Clear all channels and enable the DMAC globally. */
  380. rcar_dmac_write(dmac, RCAR_DMACHCLR, GENMASK(dmac->n_channels - 1, 0));
  381. rcar_dmac_write(dmac, RCAR_DMAOR,
  382. RCAR_DMAOR_PRI_FIXED | RCAR_DMAOR_DME);
  383. dmaor = rcar_dmac_read(dmac, RCAR_DMAOR);
  384. if ((dmaor & (RCAR_DMAOR_AE | RCAR_DMAOR_DME)) != RCAR_DMAOR_DME) {
  385. dev_warn(dmac->dev, "DMAOR initialization failed.\n");
  386. return -EIO;
  387. }
  388. return 0;
  389. }
  390. /* -----------------------------------------------------------------------------
  391. * Descriptors submission
  392. */
  393. static dma_cookie_t rcar_dmac_tx_submit(struct dma_async_tx_descriptor *tx)
  394. {
  395. struct rcar_dmac_chan *chan = to_rcar_dmac_chan(tx->chan);
  396. struct rcar_dmac_desc *desc = to_rcar_dmac_desc(tx);
  397. unsigned long flags;
  398. dma_cookie_t cookie;
  399. spin_lock_irqsave(&chan->lock, flags);
  400. cookie = dma_cookie_assign(tx);
  401. dev_dbg(chan->chan.device->dev, "chan%u: submit #%d@%p\n",
  402. chan->index, tx->cookie, desc);
  403. list_add_tail(&desc->node, &chan->desc.pending);
  404. desc->running = list_first_entry(&desc->chunks,
  405. struct rcar_dmac_xfer_chunk, node);
  406. spin_unlock_irqrestore(&chan->lock, flags);
  407. return cookie;
  408. }
  409. /* -----------------------------------------------------------------------------
  410. * Descriptors allocation and free
  411. */
  412. /*
  413. * rcar_dmac_desc_alloc - Allocate a page worth of DMA descriptors
  414. * @chan: the DMA channel
  415. * @gfp: allocation flags
  416. */
  417. static int rcar_dmac_desc_alloc(struct rcar_dmac_chan *chan, gfp_t gfp)
  418. {
  419. struct rcar_dmac_desc_page *page;
  420. unsigned long flags;
  421. LIST_HEAD(list);
  422. unsigned int i;
  423. page = (void *)get_zeroed_page(gfp);
  424. if (!page)
  425. return -ENOMEM;
  426. for (i = 0; i < RCAR_DMAC_DESCS_PER_PAGE; ++i) {
  427. struct rcar_dmac_desc *desc = &page->descs[i];
  428. dma_async_tx_descriptor_init(&desc->async_tx, &chan->chan);
  429. desc->async_tx.tx_submit = rcar_dmac_tx_submit;
  430. INIT_LIST_HEAD(&desc->chunks);
  431. list_add_tail(&desc->node, &list);
  432. }
  433. spin_lock_irqsave(&chan->lock, flags);
  434. list_splice_tail(&list, &chan->desc.free);
  435. list_add_tail(&page->node, &chan->desc.pages);
  436. spin_unlock_irqrestore(&chan->lock, flags);
  437. return 0;
  438. }
  439. /*
  440. * rcar_dmac_desc_put - Release a DMA transfer descriptor
  441. * @chan: the DMA channel
  442. * @desc: the descriptor
  443. *
  444. * Put the descriptor and its transfer chunk descriptors back in the channel's
  445. * free descriptors lists. The descriptor's chunks list will be reinitialized to
  446. * an empty list as a result.
  447. *
  448. * The descriptor must have been removed from the channel's lists before calling
  449. * this function.
  450. */
  451. static void rcar_dmac_desc_put(struct rcar_dmac_chan *chan,
  452. struct rcar_dmac_desc *desc)
  453. {
  454. unsigned long flags;
  455. spin_lock_irqsave(&chan->lock, flags);
  456. list_splice_tail_init(&desc->chunks, &chan->desc.chunks_free);
  457. list_add(&desc->node, &chan->desc.free);
  458. spin_unlock_irqrestore(&chan->lock, flags);
  459. }
  460. static void rcar_dmac_desc_recycle_acked(struct rcar_dmac_chan *chan)
  461. {
  462. struct rcar_dmac_desc *desc, *_desc;
  463. unsigned long flags;
  464. LIST_HEAD(list);
  465. /*
  466. * We have to temporarily move all descriptors from the wait list to a
  467. * local list as iterating over the wait list, even with
  468. * list_for_each_entry_safe, isn't safe if we release the channel lock
  469. * around the rcar_dmac_desc_put() call.
  470. */
  471. spin_lock_irqsave(&chan->lock, flags);
  472. list_splice_init(&chan->desc.wait, &list);
  473. spin_unlock_irqrestore(&chan->lock, flags);
  474. list_for_each_entry_safe(desc, _desc, &list, node) {
  475. if (async_tx_test_ack(&desc->async_tx)) {
  476. list_del(&desc->node);
  477. rcar_dmac_desc_put(chan, desc);
  478. }
  479. }
  480. if (list_empty(&list))
  481. return;
  482. /* Put the remaining descriptors back in the wait list. */
  483. spin_lock_irqsave(&chan->lock, flags);
  484. list_splice(&list, &chan->desc.wait);
  485. spin_unlock_irqrestore(&chan->lock, flags);
  486. }
  487. /*
  488. * rcar_dmac_desc_get - Allocate a descriptor for a DMA transfer
  489. * @chan: the DMA channel
  490. *
  491. * Locking: This function must be called in a non-atomic context.
  492. *
  493. * Return: A pointer to the allocated descriptor or NULL if no descriptor can
  494. * be allocated.
  495. */
  496. static struct rcar_dmac_desc *rcar_dmac_desc_get(struct rcar_dmac_chan *chan)
  497. {
  498. struct rcar_dmac_desc *desc;
  499. unsigned long flags;
  500. int ret;
  501. /* Recycle acked descriptors before attempting allocation. */
  502. rcar_dmac_desc_recycle_acked(chan);
  503. spin_lock_irqsave(&chan->lock, flags);
  504. while (list_empty(&chan->desc.free)) {
  505. /*
  506. * No free descriptors, allocate a page worth of them and try
  507. * again, as someone else could race us to get the newly
  508. * allocated descriptors. If the allocation fails return an
  509. * error.
  510. */
  511. spin_unlock_irqrestore(&chan->lock, flags);
  512. ret = rcar_dmac_desc_alloc(chan, GFP_NOWAIT);
  513. if (ret < 0)
  514. return NULL;
  515. spin_lock_irqsave(&chan->lock, flags);
  516. }
  517. desc = list_first_entry(&chan->desc.free, struct rcar_dmac_desc, node);
  518. list_del(&desc->node);
  519. spin_unlock_irqrestore(&chan->lock, flags);
  520. return desc;
  521. }
  522. /*
  523. * rcar_dmac_xfer_chunk_alloc - Allocate a page worth of transfer chunks
  524. * @chan: the DMA channel
  525. * @gfp: allocation flags
  526. */
  527. static int rcar_dmac_xfer_chunk_alloc(struct rcar_dmac_chan *chan, gfp_t gfp)
  528. {
  529. struct rcar_dmac_desc_page *page;
  530. unsigned long flags;
  531. LIST_HEAD(list);
  532. unsigned int i;
  533. page = (void *)get_zeroed_page(gfp);
  534. if (!page)
  535. return -ENOMEM;
  536. for (i = 0; i < RCAR_DMAC_XFER_CHUNKS_PER_PAGE; ++i) {
  537. struct rcar_dmac_xfer_chunk *chunk = &page->chunks[i];
  538. list_add_tail(&chunk->node, &list);
  539. }
  540. spin_lock_irqsave(&chan->lock, flags);
  541. list_splice_tail(&list, &chan->desc.chunks_free);
  542. list_add_tail(&page->node, &chan->desc.pages);
  543. spin_unlock_irqrestore(&chan->lock, flags);
  544. return 0;
  545. }
  546. /*
  547. * rcar_dmac_xfer_chunk_get - Allocate a transfer chunk for a DMA transfer
  548. * @chan: the DMA channel
  549. *
  550. * Locking: This function must be called in a non-atomic context.
  551. *
  552. * Return: A pointer to the allocated transfer chunk descriptor or NULL if no
  553. * descriptor can be allocated.
  554. */
  555. static struct rcar_dmac_xfer_chunk *
  556. rcar_dmac_xfer_chunk_get(struct rcar_dmac_chan *chan)
  557. {
  558. struct rcar_dmac_xfer_chunk *chunk;
  559. unsigned long flags;
  560. int ret;
  561. spin_lock_irqsave(&chan->lock, flags);
  562. while (list_empty(&chan->desc.chunks_free)) {
  563. /*
  564. * No free descriptors, allocate a page worth of them and try
  565. * again, as someone else could race us to get the newly
  566. * allocated descriptors. If the allocation fails return an
  567. * error.
  568. */
  569. spin_unlock_irqrestore(&chan->lock, flags);
  570. ret = rcar_dmac_xfer_chunk_alloc(chan, GFP_NOWAIT);
  571. if (ret < 0)
  572. return NULL;
  573. spin_lock_irqsave(&chan->lock, flags);
  574. }
  575. chunk = list_first_entry(&chan->desc.chunks_free,
  576. struct rcar_dmac_xfer_chunk, node);
  577. list_del(&chunk->node);
  578. spin_unlock_irqrestore(&chan->lock, flags);
  579. return chunk;
  580. }
  581. static void rcar_dmac_realloc_hwdesc(struct rcar_dmac_chan *chan,
  582. struct rcar_dmac_desc *desc, size_t size)
  583. {
  584. /*
  585. * dma_alloc_coherent() allocates memory in page size increments. To
  586. * avoid reallocating the hardware descriptors when the allocated size
  587. * wouldn't change align the requested size to a multiple of the page
  588. * size.
  589. */
  590. size = PAGE_ALIGN(size);
  591. if (desc->hwdescs.size == size)
  592. return;
  593. if (desc->hwdescs.mem) {
  594. dma_free_coherent(chan->chan.device->dev, desc->hwdescs.size,
  595. desc->hwdescs.mem, desc->hwdescs.dma);
  596. desc->hwdescs.mem = NULL;
  597. desc->hwdescs.size = 0;
  598. }
  599. if (!size)
  600. return;
  601. desc->hwdescs.mem = dma_alloc_coherent(chan->chan.device->dev, size,
  602. &desc->hwdescs.dma, GFP_NOWAIT);
  603. if (!desc->hwdescs.mem)
  604. return;
  605. desc->hwdescs.size = size;
  606. }
  607. static int rcar_dmac_fill_hwdesc(struct rcar_dmac_chan *chan,
  608. struct rcar_dmac_desc *desc)
  609. {
  610. struct rcar_dmac_xfer_chunk *chunk;
  611. struct rcar_dmac_hw_desc *hwdesc;
  612. rcar_dmac_realloc_hwdesc(chan, desc, desc->nchunks * sizeof(*hwdesc));
  613. hwdesc = desc->hwdescs.mem;
  614. if (!hwdesc)
  615. return -ENOMEM;
  616. list_for_each_entry(chunk, &desc->chunks, node) {
  617. hwdesc->sar = chunk->src_addr;
  618. hwdesc->dar = chunk->dst_addr;
  619. hwdesc->tcr = chunk->size >> desc->xfer_shift;
  620. hwdesc++;
  621. }
  622. return 0;
  623. }
  624. /* -----------------------------------------------------------------------------
  625. * Stop and reset
  626. */
  627. static void rcar_dmac_chan_halt(struct rcar_dmac_chan *chan)
  628. {
  629. u32 chcr = rcar_dmac_chan_read(chan, RCAR_DMACHCR);
  630. chcr &= ~(RCAR_DMACHCR_DSE | RCAR_DMACHCR_DSIE | RCAR_DMACHCR_IE |
  631. RCAR_DMACHCR_TE | RCAR_DMACHCR_DE);
  632. rcar_dmac_chan_write(chan, RCAR_DMACHCR, chcr);
  633. }
  634. static void rcar_dmac_chan_reinit(struct rcar_dmac_chan *chan)
  635. {
  636. struct rcar_dmac_desc *desc, *_desc;
  637. unsigned long flags;
  638. LIST_HEAD(descs);
  639. spin_lock_irqsave(&chan->lock, flags);
  640. /* Move all non-free descriptors to the local lists. */
  641. list_splice_init(&chan->desc.pending, &descs);
  642. list_splice_init(&chan->desc.active, &descs);
  643. list_splice_init(&chan->desc.done, &descs);
  644. list_splice_init(&chan->desc.wait, &descs);
  645. chan->desc.running = NULL;
  646. spin_unlock_irqrestore(&chan->lock, flags);
  647. list_for_each_entry_safe(desc, _desc, &descs, node) {
  648. list_del(&desc->node);
  649. rcar_dmac_desc_put(chan, desc);
  650. }
  651. }
  652. static void rcar_dmac_stop(struct rcar_dmac *dmac)
  653. {
  654. rcar_dmac_write(dmac, RCAR_DMAOR, 0);
  655. }
  656. static void rcar_dmac_abort(struct rcar_dmac *dmac)
  657. {
  658. unsigned int i;
  659. /* Stop all channels. */
  660. for (i = 0; i < dmac->n_channels; ++i) {
  661. struct rcar_dmac_chan *chan = &dmac->channels[i];
  662. /* Stop and reinitialize the channel. */
  663. spin_lock(&chan->lock);
  664. rcar_dmac_chan_halt(chan);
  665. spin_unlock(&chan->lock);
  666. rcar_dmac_chan_reinit(chan);
  667. }
  668. }
  669. /* -----------------------------------------------------------------------------
  670. * Descriptors preparation
  671. */
  672. static void rcar_dmac_chan_configure_desc(struct rcar_dmac_chan *chan,
  673. struct rcar_dmac_desc *desc)
  674. {
  675. static const u32 chcr_ts[] = {
  676. RCAR_DMACHCR_TS_1B, RCAR_DMACHCR_TS_2B,
  677. RCAR_DMACHCR_TS_4B, RCAR_DMACHCR_TS_8B,
  678. RCAR_DMACHCR_TS_16B, RCAR_DMACHCR_TS_32B,
  679. RCAR_DMACHCR_TS_64B,
  680. };
  681. unsigned int xfer_size;
  682. u32 chcr;
  683. switch (desc->direction) {
  684. case DMA_DEV_TO_MEM:
  685. chcr = RCAR_DMACHCR_DM_INC | RCAR_DMACHCR_SM_FIXED
  686. | RCAR_DMACHCR_RS_DMARS;
  687. xfer_size = chan->src.xfer_size;
  688. break;
  689. case DMA_MEM_TO_DEV:
  690. chcr = RCAR_DMACHCR_DM_FIXED | RCAR_DMACHCR_SM_INC
  691. | RCAR_DMACHCR_RS_DMARS;
  692. xfer_size = chan->dst.xfer_size;
  693. break;
  694. case DMA_MEM_TO_MEM:
  695. default:
  696. chcr = RCAR_DMACHCR_DM_INC | RCAR_DMACHCR_SM_INC
  697. | RCAR_DMACHCR_RS_AUTO;
  698. xfer_size = RCAR_DMAC_MEMCPY_XFER_SIZE;
  699. break;
  700. }
  701. desc->xfer_shift = ilog2(xfer_size);
  702. desc->chcr = chcr | chcr_ts[desc->xfer_shift];
  703. }
  704. /*
  705. * rcar_dmac_chan_prep_sg - prepare transfer descriptors from an SG list
  706. *
  707. * Common routine for public (MEMCPY) and slave DMA. The MEMCPY case is also
  708. * converted to scatter-gather to guarantee consistent locking and a correct
  709. * list manipulation. For slave DMA direction carries the usual meaning, and,
  710. * logically, the SG list is RAM and the addr variable contains slave address,
  711. * e.g., the FIFO I/O register. For MEMCPY direction equals DMA_MEM_TO_MEM
  712. * and the SG list contains only one element and points at the source buffer.
  713. */
  714. static struct dma_async_tx_descriptor *
  715. rcar_dmac_chan_prep_sg(struct rcar_dmac_chan *chan, struct scatterlist *sgl,
  716. unsigned int sg_len, dma_addr_t dev_addr,
  717. enum dma_transfer_direction dir, unsigned long dma_flags,
  718. bool cyclic)
  719. {
  720. struct rcar_dmac_xfer_chunk *chunk;
  721. struct rcar_dmac_desc *desc;
  722. struct scatterlist *sg;
  723. unsigned int nchunks = 0;
  724. unsigned int max_chunk_size;
  725. unsigned int full_size = 0;
  726. bool highmem = false;
  727. unsigned int i;
  728. desc = rcar_dmac_desc_get(chan);
  729. if (!desc)
  730. return NULL;
  731. desc->async_tx.flags = dma_flags;
  732. desc->async_tx.cookie = -EBUSY;
  733. desc->cyclic = cyclic;
  734. desc->direction = dir;
  735. rcar_dmac_chan_configure_desc(chan, desc);
  736. max_chunk_size = (RCAR_DMATCR_MASK + 1) << desc->xfer_shift;
  737. /*
  738. * Allocate and fill the transfer chunk descriptors. We own the only
  739. * reference to the DMA descriptor, there's no need for locking.
  740. */
  741. for_each_sg(sgl, sg, sg_len, i) {
  742. dma_addr_t mem_addr = sg_dma_address(sg);
  743. unsigned int len = sg_dma_len(sg);
  744. full_size += len;
  745. while (len) {
  746. unsigned int size = min(len, max_chunk_size);
  747. #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
  748. /*
  749. * Prevent individual transfers from crossing 4GB
  750. * boundaries.
  751. */
  752. if (dev_addr >> 32 != (dev_addr + size - 1) >> 32)
  753. size = ALIGN(dev_addr, 1ULL << 32) - dev_addr;
  754. if (mem_addr >> 32 != (mem_addr + size - 1) >> 32)
  755. size = ALIGN(mem_addr, 1ULL << 32) - mem_addr;
  756. /*
  757. * Check if either of the source or destination address
  758. * can't be expressed in 32 bits. If so we can't use
  759. * hardware descriptor lists.
  760. */
  761. if (dev_addr >> 32 || mem_addr >> 32)
  762. highmem = true;
  763. #endif
  764. chunk = rcar_dmac_xfer_chunk_get(chan);
  765. if (!chunk) {
  766. rcar_dmac_desc_put(chan, desc);
  767. return NULL;
  768. }
  769. if (dir == DMA_DEV_TO_MEM) {
  770. chunk->src_addr = dev_addr;
  771. chunk->dst_addr = mem_addr;
  772. } else {
  773. chunk->src_addr = mem_addr;
  774. chunk->dst_addr = dev_addr;
  775. }
  776. chunk->size = size;
  777. dev_dbg(chan->chan.device->dev,
  778. "chan%u: chunk %p/%p sgl %u@%p, %u/%u %pad -> %pad\n",
  779. chan->index, chunk, desc, i, sg, size, len,
  780. &chunk->src_addr, &chunk->dst_addr);
  781. mem_addr += size;
  782. if (dir == DMA_MEM_TO_MEM)
  783. dev_addr += size;
  784. len -= size;
  785. list_add_tail(&chunk->node, &desc->chunks);
  786. nchunks++;
  787. }
  788. }
  789. desc->nchunks = nchunks;
  790. desc->size = full_size;
  791. /*
  792. * Use hardware descriptor lists if possible when more than one chunk
  793. * needs to be transferred (otherwise they don't make much sense).
  794. *
  795. * The highmem check currently covers the whole transfer. As an
  796. * optimization we could use descriptor lists for consecutive lowmem
  797. * chunks and direct manual mode for highmem chunks. Whether the
  798. * performance improvement would be significant enough compared to the
  799. * additional complexity remains to be investigated.
  800. */
  801. desc->hwdescs.use = !highmem && nchunks > 1;
  802. if (desc->hwdescs.use) {
  803. if (rcar_dmac_fill_hwdesc(chan, desc) < 0)
  804. desc->hwdescs.use = false;
  805. }
  806. return &desc->async_tx;
  807. }
  808. /* -----------------------------------------------------------------------------
  809. * DMA engine operations
  810. */
  811. static int rcar_dmac_alloc_chan_resources(struct dma_chan *chan)
  812. {
  813. struct rcar_dmac_chan *rchan = to_rcar_dmac_chan(chan);
  814. int ret;
  815. INIT_LIST_HEAD(&rchan->desc.chunks_free);
  816. INIT_LIST_HEAD(&rchan->desc.pages);
  817. /* Preallocate descriptors. */
  818. ret = rcar_dmac_xfer_chunk_alloc(rchan, GFP_KERNEL);
  819. if (ret < 0)
  820. return -ENOMEM;
  821. ret = rcar_dmac_desc_alloc(rchan, GFP_KERNEL);
  822. if (ret < 0)
  823. return -ENOMEM;
  824. return pm_runtime_get_sync(chan->device->dev);
  825. }
  826. static void rcar_dmac_free_chan_resources(struct dma_chan *chan)
  827. {
  828. struct rcar_dmac_chan *rchan = to_rcar_dmac_chan(chan);
  829. struct rcar_dmac *dmac = to_rcar_dmac(chan->device);
  830. struct rcar_dmac_chan_map *map = &rchan->map;
  831. struct rcar_dmac_desc_page *page, *_page;
  832. struct rcar_dmac_desc *desc;
  833. LIST_HEAD(list);
  834. /* Protect against ISR */
  835. spin_lock_irq(&rchan->lock);
  836. rcar_dmac_chan_halt(rchan);
  837. spin_unlock_irq(&rchan->lock);
  838. /* Now no new interrupts will occur */
  839. if (rchan->mid_rid >= 0) {
  840. /* The caller is holding dma_list_mutex */
  841. clear_bit(rchan->mid_rid, dmac->modules);
  842. rchan->mid_rid = -EINVAL;
  843. }
  844. list_splice_init(&rchan->desc.free, &list);
  845. list_splice_init(&rchan->desc.pending, &list);
  846. list_splice_init(&rchan->desc.active, &list);
  847. list_splice_init(&rchan->desc.done, &list);
  848. list_splice_init(&rchan->desc.wait, &list);
  849. rchan->desc.running = NULL;
  850. list_for_each_entry(desc, &list, node)
  851. rcar_dmac_realloc_hwdesc(rchan, desc, 0);
  852. list_for_each_entry_safe(page, _page, &rchan->desc.pages, node) {
  853. list_del(&page->node);
  854. free_page((unsigned long)page);
  855. }
  856. /* Remove slave mapping if present. */
  857. if (map->slave.xfer_size) {
  858. dma_unmap_resource(chan->device->dev, map->addr,
  859. map->slave.xfer_size, map->dir, 0);
  860. map->slave.xfer_size = 0;
  861. }
  862. pm_runtime_put(chan->device->dev);
  863. }
  864. static struct dma_async_tx_descriptor *
  865. rcar_dmac_prep_dma_memcpy(struct dma_chan *chan, dma_addr_t dma_dest,
  866. dma_addr_t dma_src, size_t len, unsigned long flags)
  867. {
  868. struct rcar_dmac_chan *rchan = to_rcar_dmac_chan(chan);
  869. struct scatterlist sgl;
  870. if (!len)
  871. return NULL;
  872. sg_init_table(&sgl, 1);
  873. sg_set_page(&sgl, pfn_to_page(PFN_DOWN(dma_src)), len,
  874. offset_in_page(dma_src));
  875. sg_dma_address(&sgl) = dma_src;
  876. sg_dma_len(&sgl) = len;
  877. return rcar_dmac_chan_prep_sg(rchan, &sgl, 1, dma_dest,
  878. DMA_MEM_TO_MEM, flags, false);
  879. }
  880. static int rcar_dmac_map_slave_addr(struct dma_chan *chan,
  881. enum dma_transfer_direction dir)
  882. {
  883. struct rcar_dmac_chan *rchan = to_rcar_dmac_chan(chan);
  884. struct rcar_dmac_chan_map *map = &rchan->map;
  885. phys_addr_t dev_addr;
  886. size_t dev_size;
  887. enum dma_data_direction dev_dir;
  888. if (dir == DMA_DEV_TO_MEM) {
  889. dev_addr = rchan->src.slave_addr;
  890. dev_size = rchan->src.xfer_size;
  891. dev_dir = DMA_TO_DEVICE;
  892. } else {
  893. dev_addr = rchan->dst.slave_addr;
  894. dev_size = rchan->dst.xfer_size;
  895. dev_dir = DMA_FROM_DEVICE;
  896. }
  897. /* Reuse current map if possible. */
  898. if (dev_addr == map->slave.slave_addr &&
  899. dev_size == map->slave.xfer_size &&
  900. dev_dir == map->dir)
  901. return 0;
  902. /* Remove old mapping if present. */
  903. if (map->slave.xfer_size)
  904. dma_unmap_resource(chan->device->dev, map->addr,
  905. map->slave.xfer_size, map->dir, 0);
  906. map->slave.xfer_size = 0;
  907. /* Create new slave address map. */
  908. map->addr = dma_map_resource(chan->device->dev, dev_addr, dev_size,
  909. dev_dir, 0);
  910. if (dma_mapping_error(chan->device->dev, map->addr)) {
  911. dev_err(chan->device->dev,
  912. "chan%u: failed to map %zx@%pap", rchan->index,
  913. dev_size, &dev_addr);
  914. return -EIO;
  915. }
  916. dev_dbg(chan->device->dev, "chan%u: map %zx@%pap to %pad dir: %s\n",
  917. rchan->index, dev_size, &dev_addr, &map->addr,
  918. dev_dir == DMA_TO_DEVICE ? "DMA_TO_DEVICE" : "DMA_FROM_DEVICE");
  919. map->slave.slave_addr = dev_addr;
  920. map->slave.xfer_size = dev_size;
  921. map->dir = dev_dir;
  922. return 0;
  923. }
  924. static struct dma_async_tx_descriptor *
  925. rcar_dmac_prep_slave_sg(struct dma_chan *chan, struct scatterlist *sgl,
  926. unsigned int sg_len, enum dma_transfer_direction dir,
  927. unsigned long flags, void *context)
  928. {
  929. struct rcar_dmac_chan *rchan = to_rcar_dmac_chan(chan);
  930. /* Someone calling slave DMA on a generic channel? */
  931. if (rchan->mid_rid < 0 || !sg_len) {
  932. dev_warn(chan->device->dev,
  933. "%s: bad parameter: len=%d, id=%d\n",
  934. __func__, sg_len, rchan->mid_rid);
  935. return NULL;
  936. }
  937. if (rcar_dmac_map_slave_addr(chan, dir))
  938. return NULL;
  939. return rcar_dmac_chan_prep_sg(rchan, sgl, sg_len, rchan->map.addr,
  940. dir, flags, false);
  941. }
  942. #define RCAR_DMAC_MAX_SG_LEN 32
  943. static struct dma_async_tx_descriptor *
  944. rcar_dmac_prep_dma_cyclic(struct dma_chan *chan, dma_addr_t buf_addr,
  945. size_t buf_len, size_t period_len,
  946. enum dma_transfer_direction dir, unsigned long flags)
  947. {
  948. struct rcar_dmac_chan *rchan = to_rcar_dmac_chan(chan);
  949. struct dma_async_tx_descriptor *desc;
  950. struct scatterlist *sgl;
  951. unsigned int sg_len;
  952. unsigned int i;
  953. /* Someone calling slave DMA on a generic channel? */
  954. if (rchan->mid_rid < 0 || buf_len < period_len) {
  955. dev_warn(chan->device->dev,
  956. "%s: bad parameter: buf_len=%zu, period_len=%zu, id=%d\n",
  957. __func__, buf_len, period_len, rchan->mid_rid);
  958. return NULL;
  959. }
  960. if (rcar_dmac_map_slave_addr(chan, dir))
  961. return NULL;
  962. sg_len = buf_len / period_len;
  963. if (sg_len > RCAR_DMAC_MAX_SG_LEN) {
  964. dev_err(chan->device->dev,
  965. "chan%u: sg length %d exceds limit %d",
  966. rchan->index, sg_len, RCAR_DMAC_MAX_SG_LEN);
  967. return NULL;
  968. }
  969. /*
  970. * Allocate the sg list dynamically as it would consume too much stack
  971. * space.
  972. */
  973. sgl = kcalloc(sg_len, sizeof(*sgl), GFP_NOWAIT);
  974. if (!sgl)
  975. return NULL;
  976. sg_init_table(sgl, sg_len);
  977. for (i = 0; i < sg_len; ++i) {
  978. dma_addr_t src = buf_addr + (period_len * i);
  979. sg_set_page(&sgl[i], pfn_to_page(PFN_DOWN(src)), period_len,
  980. offset_in_page(src));
  981. sg_dma_address(&sgl[i]) = src;
  982. sg_dma_len(&sgl[i]) = period_len;
  983. }
  984. desc = rcar_dmac_chan_prep_sg(rchan, sgl, sg_len, rchan->map.addr,
  985. dir, flags, true);
  986. kfree(sgl);
  987. return desc;
  988. }
  989. static int rcar_dmac_device_config(struct dma_chan *chan,
  990. struct dma_slave_config *cfg)
  991. {
  992. struct rcar_dmac_chan *rchan = to_rcar_dmac_chan(chan);
  993. /*
  994. * We could lock this, but you shouldn't be configuring the
  995. * channel, while using it...
  996. */
  997. rchan->src.slave_addr = cfg->src_addr;
  998. rchan->dst.slave_addr = cfg->dst_addr;
  999. rchan->src.xfer_size = cfg->src_addr_width;
  1000. rchan->dst.xfer_size = cfg->dst_addr_width;
  1001. return 0;
  1002. }
  1003. static int rcar_dmac_chan_terminate_all(struct dma_chan *chan)
  1004. {
  1005. struct rcar_dmac_chan *rchan = to_rcar_dmac_chan(chan);
  1006. unsigned long flags;
  1007. spin_lock_irqsave(&rchan->lock, flags);
  1008. rcar_dmac_chan_halt(rchan);
  1009. spin_unlock_irqrestore(&rchan->lock, flags);
  1010. /*
  1011. * FIXME: No new interrupt can occur now, but the IRQ thread might still
  1012. * be running.
  1013. */
  1014. rcar_dmac_chan_reinit(rchan);
  1015. return 0;
  1016. }
  1017. static unsigned int rcar_dmac_chan_get_residue(struct rcar_dmac_chan *chan,
  1018. dma_cookie_t cookie)
  1019. {
  1020. struct rcar_dmac_desc *desc = chan->desc.running;
  1021. struct rcar_dmac_xfer_chunk *running = NULL;
  1022. struct rcar_dmac_xfer_chunk *chunk;
  1023. enum dma_status status;
  1024. unsigned int residue = 0;
  1025. unsigned int dptr = 0;
  1026. if (!desc)
  1027. return 0;
  1028. /*
  1029. * If the cookie corresponds to a descriptor that has been completed
  1030. * there is no residue. The same check has already been performed by the
  1031. * caller but without holding the channel lock, so the descriptor could
  1032. * now be complete.
  1033. */
  1034. status = dma_cookie_status(&chan->chan, cookie, NULL);
  1035. if (status == DMA_COMPLETE)
  1036. return 0;
  1037. /*
  1038. * If the cookie doesn't correspond to the currently running transfer
  1039. * then the descriptor hasn't been processed yet, and the residue is
  1040. * equal to the full descriptor size.
  1041. */
  1042. if (cookie != desc->async_tx.cookie) {
  1043. list_for_each_entry(desc, &chan->desc.pending, node) {
  1044. if (cookie == desc->async_tx.cookie)
  1045. return desc->size;
  1046. }
  1047. list_for_each_entry(desc, &chan->desc.active, node) {
  1048. if (cookie == desc->async_tx.cookie)
  1049. return desc->size;
  1050. }
  1051. /*
  1052. * No descriptor found for the cookie, there's thus no residue.
  1053. * This shouldn't happen if the calling driver passes a correct
  1054. * cookie value.
  1055. */
  1056. WARN(1, "No descriptor for cookie!");
  1057. return 0;
  1058. }
  1059. /*
  1060. * In descriptor mode the descriptor running pointer is not maintained
  1061. * by the interrupt handler, find the running descriptor from the
  1062. * descriptor pointer field in the CHCRB register. In non-descriptor
  1063. * mode just use the running descriptor pointer.
  1064. */
  1065. if (desc->hwdescs.use) {
  1066. dptr = (rcar_dmac_chan_read(chan, RCAR_DMACHCRB) &
  1067. RCAR_DMACHCRB_DPTR_MASK) >> RCAR_DMACHCRB_DPTR_SHIFT;
  1068. WARN_ON(dptr >= desc->nchunks);
  1069. } else {
  1070. running = desc->running;
  1071. }
  1072. /* Compute the size of all chunks still to be transferred. */
  1073. list_for_each_entry_reverse(chunk, &desc->chunks, node) {
  1074. if (chunk == running || ++dptr == desc->nchunks)
  1075. break;
  1076. residue += chunk->size;
  1077. }
  1078. /* Add the residue for the current chunk. */
  1079. residue += rcar_dmac_chan_read(chan, RCAR_DMATCR) << desc->xfer_shift;
  1080. return residue;
  1081. }
  1082. static enum dma_status rcar_dmac_tx_status(struct dma_chan *chan,
  1083. dma_cookie_t cookie,
  1084. struct dma_tx_state *txstate)
  1085. {
  1086. struct rcar_dmac_chan *rchan = to_rcar_dmac_chan(chan);
  1087. enum dma_status status;
  1088. unsigned long flags;
  1089. unsigned int residue;
  1090. status = dma_cookie_status(chan, cookie, txstate);
  1091. if (status == DMA_COMPLETE || !txstate)
  1092. return status;
  1093. spin_lock_irqsave(&rchan->lock, flags);
  1094. residue = rcar_dmac_chan_get_residue(rchan, cookie);
  1095. spin_unlock_irqrestore(&rchan->lock, flags);
  1096. /* if there's no residue, the cookie is complete */
  1097. if (!residue)
  1098. return DMA_COMPLETE;
  1099. dma_set_residue(txstate, residue);
  1100. return status;
  1101. }
  1102. static void rcar_dmac_issue_pending(struct dma_chan *chan)
  1103. {
  1104. struct rcar_dmac_chan *rchan = to_rcar_dmac_chan(chan);
  1105. unsigned long flags;
  1106. spin_lock_irqsave(&rchan->lock, flags);
  1107. if (list_empty(&rchan->desc.pending))
  1108. goto done;
  1109. /* Append the pending list to the active list. */
  1110. list_splice_tail_init(&rchan->desc.pending, &rchan->desc.active);
  1111. /*
  1112. * If no transfer is running pick the first descriptor from the active
  1113. * list and start the transfer.
  1114. */
  1115. if (!rchan->desc.running) {
  1116. struct rcar_dmac_desc *desc;
  1117. desc = list_first_entry(&rchan->desc.active,
  1118. struct rcar_dmac_desc, node);
  1119. rchan->desc.running = desc;
  1120. rcar_dmac_chan_start_xfer(rchan);
  1121. }
  1122. done:
  1123. spin_unlock_irqrestore(&rchan->lock, flags);
  1124. }
  1125. /* -----------------------------------------------------------------------------
  1126. * IRQ handling
  1127. */
  1128. static irqreturn_t rcar_dmac_isr_desc_stage_end(struct rcar_dmac_chan *chan)
  1129. {
  1130. struct rcar_dmac_desc *desc = chan->desc.running;
  1131. unsigned int stage;
  1132. if (WARN_ON(!desc || !desc->cyclic)) {
  1133. /*
  1134. * This should never happen, there should always be a running
  1135. * cyclic descriptor when a descriptor stage end interrupt is
  1136. * triggered. Warn and return.
  1137. */
  1138. return IRQ_NONE;
  1139. }
  1140. /* Program the interrupt pointer to the next stage. */
  1141. stage = (rcar_dmac_chan_read(chan, RCAR_DMACHCRB) &
  1142. RCAR_DMACHCRB_DPTR_MASK) >> RCAR_DMACHCRB_DPTR_SHIFT;
  1143. rcar_dmac_chan_write(chan, RCAR_DMADPCR, RCAR_DMADPCR_DIPT(stage));
  1144. return IRQ_WAKE_THREAD;
  1145. }
  1146. static irqreturn_t rcar_dmac_isr_transfer_end(struct rcar_dmac_chan *chan)
  1147. {
  1148. struct rcar_dmac_desc *desc = chan->desc.running;
  1149. irqreturn_t ret = IRQ_WAKE_THREAD;
  1150. if (WARN_ON_ONCE(!desc)) {
  1151. /*
  1152. * This should never happen, there should always be a running
  1153. * descriptor when a transfer end interrupt is triggered. Warn
  1154. * and return.
  1155. */
  1156. return IRQ_NONE;
  1157. }
  1158. /*
  1159. * The transfer end interrupt isn't generated for each chunk when using
  1160. * descriptor mode. Only update the running chunk pointer in
  1161. * non-descriptor mode.
  1162. */
  1163. if (!desc->hwdescs.use) {
  1164. /*
  1165. * If we haven't completed the last transfer chunk simply move
  1166. * to the next one. Only wake the IRQ thread if the transfer is
  1167. * cyclic.
  1168. */
  1169. if (!list_is_last(&desc->running->node, &desc->chunks)) {
  1170. desc->running = list_next_entry(desc->running, node);
  1171. if (!desc->cyclic)
  1172. ret = IRQ_HANDLED;
  1173. goto done;
  1174. }
  1175. /*
  1176. * We've completed the last transfer chunk. If the transfer is
  1177. * cyclic, move back to the first one.
  1178. */
  1179. if (desc->cyclic) {
  1180. desc->running =
  1181. list_first_entry(&desc->chunks,
  1182. struct rcar_dmac_xfer_chunk,
  1183. node);
  1184. goto done;
  1185. }
  1186. }
  1187. /* The descriptor is complete, move it to the done list. */
  1188. list_move_tail(&desc->node, &chan->desc.done);
  1189. /* Queue the next descriptor, if any. */
  1190. if (!list_empty(&chan->desc.active))
  1191. chan->desc.running = list_first_entry(&chan->desc.active,
  1192. struct rcar_dmac_desc,
  1193. node);
  1194. else
  1195. chan->desc.running = NULL;
  1196. done:
  1197. if (chan->desc.running)
  1198. rcar_dmac_chan_start_xfer(chan);
  1199. return ret;
  1200. }
  1201. static irqreturn_t rcar_dmac_isr_channel(int irq, void *dev)
  1202. {
  1203. u32 mask = RCAR_DMACHCR_DSE | RCAR_DMACHCR_TE;
  1204. struct rcar_dmac_chan *chan = dev;
  1205. irqreturn_t ret = IRQ_NONE;
  1206. u32 chcr;
  1207. spin_lock(&chan->lock);
  1208. chcr = rcar_dmac_chan_read(chan, RCAR_DMACHCR);
  1209. if (chcr & RCAR_DMACHCR_TE)
  1210. mask |= RCAR_DMACHCR_DE;
  1211. rcar_dmac_chan_write(chan, RCAR_DMACHCR, chcr & ~mask);
  1212. if (chcr & RCAR_DMACHCR_DSE)
  1213. ret |= rcar_dmac_isr_desc_stage_end(chan);
  1214. if (chcr & RCAR_DMACHCR_TE)
  1215. ret |= rcar_dmac_isr_transfer_end(chan);
  1216. spin_unlock(&chan->lock);
  1217. return ret;
  1218. }
  1219. static irqreturn_t rcar_dmac_isr_channel_thread(int irq, void *dev)
  1220. {
  1221. struct rcar_dmac_chan *chan = dev;
  1222. struct rcar_dmac_desc *desc;
  1223. struct dmaengine_desc_callback cb;
  1224. spin_lock_irq(&chan->lock);
  1225. /* For cyclic transfers notify the user after every chunk. */
  1226. if (chan->desc.running && chan->desc.running->cyclic) {
  1227. desc = chan->desc.running;
  1228. dmaengine_desc_get_callback(&desc->async_tx, &cb);
  1229. if (dmaengine_desc_callback_valid(&cb)) {
  1230. spin_unlock_irq(&chan->lock);
  1231. dmaengine_desc_callback_invoke(&cb, NULL);
  1232. spin_lock_irq(&chan->lock);
  1233. }
  1234. }
  1235. /*
  1236. * Call the callback function for all descriptors on the done list and
  1237. * move them to the ack wait list.
  1238. */
  1239. while (!list_empty(&chan->desc.done)) {
  1240. desc = list_first_entry(&chan->desc.done, struct rcar_dmac_desc,
  1241. node);
  1242. dma_cookie_complete(&desc->async_tx);
  1243. list_del(&desc->node);
  1244. dmaengine_desc_get_callback(&desc->async_tx, &cb);
  1245. if (dmaengine_desc_callback_valid(&cb)) {
  1246. spin_unlock_irq(&chan->lock);
  1247. /*
  1248. * We own the only reference to this descriptor, we can
  1249. * safely dereference it without holding the channel
  1250. * lock.
  1251. */
  1252. dmaengine_desc_callback_invoke(&cb, NULL);
  1253. spin_lock_irq(&chan->lock);
  1254. }
  1255. list_add_tail(&desc->node, &chan->desc.wait);
  1256. }
  1257. spin_unlock_irq(&chan->lock);
  1258. /* Recycle all acked descriptors. */
  1259. rcar_dmac_desc_recycle_acked(chan);
  1260. return IRQ_HANDLED;
  1261. }
  1262. static irqreturn_t rcar_dmac_isr_error(int irq, void *data)
  1263. {
  1264. struct rcar_dmac *dmac = data;
  1265. if (!(rcar_dmac_read(dmac, RCAR_DMAOR) & RCAR_DMAOR_AE))
  1266. return IRQ_NONE;
  1267. /*
  1268. * An unrecoverable error occurred on an unknown channel. Halt the DMAC,
  1269. * abort transfers on all channels, and reinitialize the DMAC.
  1270. */
  1271. rcar_dmac_stop(dmac);
  1272. rcar_dmac_abort(dmac);
  1273. rcar_dmac_init(dmac);
  1274. return IRQ_HANDLED;
  1275. }
  1276. /* -----------------------------------------------------------------------------
  1277. * OF xlate and channel filter
  1278. */
  1279. static bool rcar_dmac_chan_filter(struct dma_chan *chan, void *arg)
  1280. {
  1281. struct rcar_dmac *dmac = to_rcar_dmac(chan->device);
  1282. struct of_phandle_args *dma_spec = arg;
  1283. /*
  1284. * FIXME: Using a filter on OF platforms is a nonsense. The OF xlate
  1285. * function knows from which device it wants to allocate a channel from,
  1286. * and would be perfectly capable of selecting the channel it wants.
  1287. * Forcing it to call dma_request_channel() and iterate through all
  1288. * channels from all controllers is just pointless.
  1289. */
  1290. if (chan->device->device_config != rcar_dmac_device_config ||
  1291. dma_spec->np != chan->device->dev->of_node)
  1292. return false;
  1293. return !test_and_set_bit(dma_spec->args[0], dmac->modules);
  1294. }
  1295. static struct dma_chan *rcar_dmac_of_xlate(struct of_phandle_args *dma_spec,
  1296. struct of_dma *ofdma)
  1297. {
  1298. struct rcar_dmac_chan *rchan;
  1299. struct dma_chan *chan;
  1300. dma_cap_mask_t mask;
  1301. if (dma_spec->args_count != 1)
  1302. return NULL;
  1303. /* Only slave DMA channels can be allocated via DT */
  1304. dma_cap_zero(mask);
  1305. dma_cap_set(DMA_SLAVE, mask);
  1306. chan = dma_request_channel(mask, rcar_dmac_chan_filter, dma_spec);
  1307. if (!chan)
  1308. return NULL;
  1309. rchan = to_rcar_dmac_chan(chan);
  1310. rchan->mid_rid = dma_spec->args[0];
  1311. return chan;
  1312. }
  1313. /* -----------------------------------------------------------------------------
  1314. * Power management
  1315. */
  1316. #ifdef CONFIG_PM_SLEEP
  1317. static int rcar_dmac_sleep_suspend(struct device *dev)
  1318. {
  1319. /*
  1320. * TODO: Wait for the current transfer to complete and stop the device.
  1321. */
  1322. return 0;
  1323. }
  1324. static int rcar_dmac_sleep_resume(struct device *dev)
  1325. {
  1326. /* TODO: Resume transfers, if any. */
  1327. return 0;
  1328. }
  1329. #endif
  1330. #ifdef CONFIG_PM
  1331. static int rcar_dmac_runtime_suspend(struct device *dev)
  1332. {
  1333. return 0;
  1334. }
  1335. static int rcar_dmac_runtime_resume(struct device *dev)
  1336. {
  1337. struct rcar_dmac *dmac = dev_get_drvdata(dev);
  1338. return rcar_dmac_init(dmac);
  1339. }
  1340. #endif
  1341. static const struct dev_pm_ops rcar_dmac_pm = {
  1342. SET_SYSTEM_SLEEP_PM_OPS(rcar_dmac_sleep_suspend, rcar_dmac_sleep_resume)
  1343. SET_RUNTIME_PM_OPS(rcar_dmac_runtime_suspend, rcar_dmac_runtime_resume,
  1344. NULL)
  1345. };
  1346. /* -----------------------------------------------------------------------------
  1347. * Probe and remove
  1348. */
  1349. static int rcar_dmac_chan_probe(struct rcar_dmac *dmac,
  1350. struct rcar_dmac_chan *rchan,
  1351. unsigned int index)
  1352. {
  1353. struct platform_device *pdev = to_platform_device(dmac->dev);
  1354. struct dma_chan *chan = &rchan->chan;
  1355. char pdev_irqname[5];
  1356. char *irqname;
  1357. int irq;
  1358. int ret;
  1359. rchan->index = index;
  1360. rchan->iomem = dmac->iomem + RCAR_DMAC_CHAN_OFFSET(index);
  1361. rchan->mid_rid = -EINVAL;
  1362. spin_lock_init(&rchan->lock);
  1363. INIT_LIST_HEAD(&rchan->desc.free);
  1364. INIT_LIST_HEAD(&rchan->desc.pending);
  1365. INIT_LIST_HEAD(&rchan->desc.active);
  1366. INIT_LIST_HEAD(&rchan->desc.done);
  1367. INIT_LIST_HEAD(&rchan->desc.wait);
  1368. /* Request the channel interrupt. */
  1369. sprintf(pdev_irqname, "ch%u", index);
  1370. irq = platform_get_irq_byname(pdev, pdev_irqname);
  1371. if (irq < 0) {
  1372. dev_err(dmac->dev, "no IRQ specified for channel %u\n", index);
  1373. return -ENODEV;
  1374. }
  1375. irqname = devm_kasprintf(dmac->dev, GFP_KERNEL, "%s:%u",
  1376. dev_name(dmac->dev), index);
  1377. if (!irqname)
  1378. return -ENOMEM;
  1379. ret = devm_request_threaded_irq(dmac->dev, irq, rcar_dmac_isr_channel,
  1380. rcar_dmac_isr_channel_thread, 0,
  1381. irqname, rchan);
  1382. if (ret) {
  1383. dev_err(dmac->dev, "failed to request IRQ %u (%d)\n", irq, ret);
  1384. return ret;
  1385. }
  1386. /*
  1387. * Initialize the DMA engine channel and add it to the DMA engine
  1388. * channels list.
  1389. */
  1390. chan->device = &dmac->engine;
  1391. dma_cookie_init(chan);
  1392. list_add_tail(&chan->device_node, &dmac->engine.channels);
  1393. return 0;
  1394. }
  1395. static int rcar_dmac_parse_of(struct device *dev, struct rcar_dmac *dmac)
  1396. {
  1397. struct device_node *np = dev->of_node;
  1398. int ret;
  1399. ret = of_property_read_u32(np, "dma-channels", &dmac->n_channels);
  1400. if (ret < 0) {
  1401. dev_err(dev, "unable to read dma-channels property\n");
  1402. return ret;
  1403. }
  1404. if (dmac->n_channels <= 0 || dmac->n_channels >= 100) {
  1405. dev_err(dev, "invalid number of channels %u\n",
  1406. dmac->n_channels);
  1407. return -EINVAL;
  1408. }
  1409. return 0;
  1410. }
  1411. static int rcar_dmac_probe(struct platform_device *pdev)
  1412. {
  1413. const enum dma_slave_buswidth widths = DMA_SLAVE_BUSWIDTH_1_BYTE |
  1414. DMA_SLAVE_BUSWIDTH_2_BYTES | DMA_SLAVE_BUSWIDTH_4_BYTES |
  1415. DMA_SLAVE_BUSWIDTH_8_BYTES | DMA_SLAVE_BUSWIDTH_16_BYTES |
  1416. DMA_SLAVE_BUSWIDTH_32_BYTES | DMA_SLAVE_BUSWIDTH_64_BYTES;
  1417. unsigned int channels_offset = 0;
  1418. struct dma_device *engine;
  1419. struct rcar_dmac *dmac;
  1420. struct resource *mem;
  1421. unsigned int i;
  1422. char *irqname;
  1423. int irq;
  1424. int ret;
  1425. dmac = devm_kzalloc(&pdev->dev, sizeof(*dmac), GFP_KERNEL);
  1426. if (!dmac)
  1427. return -ENOMEM;
  1428. dmac->dev = &pdev->dev;
  1429. platform_set_drvdata(pdev, dmac);
  1430. ret = rcar_dmac_parse_of(&pdev->dev, dmac);
  1431. if (ret < 0)
  1432. return ret;
  1433. /*
  1434. * A still unconfirmed hardware bug prevents the IPMMU microTLB 0 to be
  1435. * flushed correctly, resulting in memory corruption. DMAC 0 channel 0
  1436. * is connected to microTLB 0 on currently supported platforms, so we
  1437. * can't use it with the IPMMU. As the IOMMU API operates at the device
  1438. * level we can't disable it selectively, so ignore channel 0 for now if
  1439. * the device is part of an IOMMU group.
  1440. */
  1441. if (pdev->dev.iommu_group) {
  1442. dmac->n_channels--;
  1443. channels_offset = 1;
  1444. }
  1445. dmac->channels = devm_kcalloc(&pdev->dev, dmac->n_channels,
  1446. sizeof(*dmac->channels), GFP_KERNEL);
  1447. if (!dmac->channels)
  1448. return -ENOMEM;
  1449. /* Request resources. */
  1450. mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1451. dmac->iomem = devm_ioremap_resource(&pdev->dev, mem);
  1452. if (IS_ERR(dmac->iomem))
  1453. return PTR_ERR(dmac->iomem);
  1454. irq = platform_get_irq_byname(pdev, "error");
  1455. if (irq < 0) {
  1456. dev_err(&pdev->dev, "no error IRQ specified\n");
  1457. return -ENODEV;
  1458. }
  1459. irqname = devm_kasprintf(dmac->dev, GFP_KERNEL, "%s:error",
  1460. dev_name(dmac->dev));
  1461. if (!irqname)
  1462. return -ENOMEM;
  1463. ret = devm_request_irq(&pdev->dev, irq, rcar_dmac_isr_error, 0,
  1464. irqname, dmac);
  1465. if (ret) {
  1466. dev_err(&pdev->dev, "failed to request IRQ %u (%d)\n",
  1467. irq, ret);
  1468. return ret;
  1469. }
  1470. /* Enable runtime PM and initialize the device. */
  1471. pm_runtime_enable(&pdev->dev);
  1472. ret = pm_runtime_get_sync(&pdev->dev);
  1473. if (ret < 0) {
  1474. dev_err(&pdev->dev, "runtime PM get sync failed (%d)\n", ret);
  1475. return ret;
  1476. }
  1477. ret = rcar_dmac_init(dmac);
  1478. pm_runtime_put(&pdev->dev);
  1479. if (ret) {
  1480. dev_err(&pdev->dev, "failed to reset device\n");
  1481. goto error;
  1482. }
  1483. /* Initialize the channels. */
  1484. INIT_LIST_HEAD(&dmac->engine.channels);
  1485. for (i = 0; i < dmac->n_channels; ++i) {
  1486. ret = rcar_dmac_chan_probe(dmac, &dmac->channels[i],
  1487. i + channels_offset);
  1488. if (ret < 0)
  1489. goto error;
  1490. }
  1491. /* Register the DMAC as a DMA provider for DT. */
  1492. ret = of_dma_controller_register(pdev->dev.of_node, rcar_dmac_of_xlate,
  1493. NULL);
  1494. if (ret < 0)
  1495. goto error;
  1496. /*
  1497. * Register the DMA engine device.
  1498. *
  1499. * Default transfer size of 32 bytes requires 32-byte alignment.
  1500. */
  1501. engine = &dmac->engine;
  1502. dma_cap_set(DMA_MEMCPY, engine->cap_mask);
  1503. dma_cap_set(DMA_SLAVE, engine->cap_mask);
  1504. engine->dev = &pdev->dev;
  1505. engine->copy_align = ilog2(RCAR_DMAC_MEMCPY_XFER_SIZE);
  1506. engine->src_addr_widths = widths;
  1507. engine->dst_addr_widths = widths;
  1508. engine->directions = BIT(DMA_MEM_TO_DEV) | BIT(DMA_DEV_TO_MEM);
  1509. engine->residue_granularity = DMA_RESIDUE_GRANULARITY_BURST;
  1510. engine->device_alloc_chan_resources = rcar_dmac_alloc_chan_resources;
  1511. engine->device_free_chan_resources = rcar_dmac_free_chan_resources;
  1512. engine->device_prep_dma_memcpy = rcar_dmac_prep_dma_memcpy;
  1513. engine->device_prep_slave_sg = rcar_dmac_prep_slave_sg;
  1514. engine->device_prep_dma_cyclic = rcar_dmac_prep_dma_cyclic;
  1515. engine->device_config = rcar_dmac_device_config;
  1516. engine->device_terminate_all = rcar_dmac_chan_terminate_all;
  1517. engine->device_tx_status = rcar_dmac_tx_status;
  1518. engine->device_issue_pending = rcar_dmac_issue_pending;
  1519. ret = dma_async_device_register(engine);
  1520. if (ret < 0)
  1521. goto error;
  1522. return 0;
  1523. error:
  1524. of_dma_controller_free(pdev->dev.of_node);
  1525. pm_runtime_disable(&pdev->dev);
  1526. return ret;
  1527. }
  1528. static int rcar_dmac_remove(struct platform_device *pdev)
  1529. {
  1530. struct rcar_dmac *dmac = platform_get_drvdata(pdev);
  1531. of_dma_controller_free(pdev->dev.of_node);
  1532. dma_async_device_unregister(&dmac->engine);
  1533. pm_runtime_disable(&pdev->dev);
  1534. return 0;
  1535. }
  1536. static void rcar_dmac_shutdown(struct platform_device *pdev)
  1537. {
  1538. struct rcar_dmac *dmac = platform_get_drvdata(pdev);
  1539. rcar_dmac_stop(dmac);
  1540. }
  1541. static const struct of_device_id rcar_dmac_of_ids[] = {
  1542. { .compatible = "renesas,rcar-dmac", },
  1543. { /* Sentinel */ }
  1544. };
  1545. MODULE_DEVICE_TABLE(of, rcar_dmac_of_ids);
  1546. static struct platform_driver rcar_dmac_driver = {
  1547. .driver = {
  1548. .pm = &rcar_dmac_pm,
  1549. .name = "rcar-dmac",
  1550. .of_match_table = rcar_dmac_of_ids,
  1551. },
  1552. .probe = rcar_dmac_probe,
  1553. .remove = rcar_dmac_remove,
  1554. .shutdown = rcar_dmac_shutdown,
  1555. };
  1556. module_platform_driver(rcar_dmac_driver);
  1557. MODULE_DESCRIPTION("R-Car Gen2 DMA Controller Driver");
  1558. MODULE_AUTHOR("Laurent Pinchart <laurent.pinchart@ideasonboard.com>");
  1559. MODULE_LICENSE("GPL v2");