xref: /openbmc/linux/drivers/dma/xilinx/zynqmp_dma.c (revision c699ce1a)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * DMA driver for Xilinx ZynqMP DMA Engine
4  *
5  * Copyright (C) 2016 Xilinx, Inc. All rights reserved.
6  */
7 
8 #include <linux/bitops.h>
9 #include <linux/dma-mapping.h>
10 #include <linux/init.h>
11 #include <linux/interrupt.h>
12 #include <linux/io.h>
13 #include <linux/module.h>
14 #include <linux/of_dma.h>
15 #include <linux/of_platform.h>
16 #include <linux/slab.h>
17 #include <linux/clk.h>
18 #include <linux/io-64-nonatomic-lo-hi.h>
19 #include <linux/pm_runtime.h>
20 
21 #include "../dmaengine.h"
22 
23 /* Register Offsets */
24 #define ZYNQMP_DMA_ISR			0x100
25 #define ZYNQMP_DMA_IMR			0x104
26 #define ZYNQMP_DMA_IER			0x108
27 #define ZYNQMP_DMA_IDS			0x10C
28 #define ZYNQMP_DMA_CTRL0		0x110
29 #define ZYNQMP_DMA_CTRL1		0x114
30 #define ZYNQMP_DMA_DATA_ATTR		0x120
31 #define ZYNQMP_DMA_DSCR_ATTR		0x124
32 #define ZYNQMP_DMA_SRC_DSCR_WRD0	0x128
33 #define ZYNQMP_DMA_SRC_DSCR_WRD1	0x12C
34 #define ZYNQMP_DMA_SRC_DSCR_WRD2	0x130
35 #define ZYNQMP_DMA_SRC_DSCR_WRD3	0x134
36 #define ZYNQMP_DMA_DST_DSCR_WRD0	0x138
37 #define ZYNQMP_DMA_DST_DSCR_WRD1	0x13C
38 #define ZYNQMP_DMA_DST_DSCR_WRD2	0x140
39 #define ZYNQMP_DMA_DST_DSCR_WRD3	0x144
40 #define ZYNQMP_DMA_SRC_START_LSB	0x158
41 #define ZYNQMP_DMA_SRC_START_MSB	0x15C
42 #define ZYNQMP_DMA_DST_START_LSB	0x160
43 #define ZYNQMP_DMA_DST_START_MSB	0x164
44 #define ZYNQMP_DMA_TOTAL_BYTE		0x188
45 #define ZYNQMP_DMA_RATE_CTRL		0x18C
46 #define ZYNQMP_DMA_IRQ_SRC_ACCT		0x190
47 #define ZYNQMP_DMA_IRQ_DST_ACCT		0x194
48 #define ZYNQMP_DMA_CTRL2		0x200
49 
50 /* Interrupt registers bit field definitions */
51 #define ZYNQMP_DMA_DONE			BIT(10)
52 #define ZYNQMP_DMA_AXI_WR_DATA		BIT(9)
53 #define ZYNQMP_DMA_AXI_RD_DATA		BIT(8)
54 #define ZYNQMP_DMA_AXI_RD_DST_DSCR	BIT(7)
55 #define ZYNQMP_DMA_AXI_RD_SRC_DSCR	BIT(6)
56 #define ZYNQMP_DMA_IRQ_DST_ACCT_ERR	BIT(5)
57 #define ZYNQMP_DMA_IRQ_SRC_ACCT_ERR	BIT(4)
58 #define ZYNQMP_DMA_BYTE_CNT_OVRFL	BIT(3)
59 #define ZYNQMP_DMA_DST_DSCR_DONE	BIT(2)
60 #define ZYNQMP_DMA_INV_APB		BIT(0)
61 
62 /* Control 0 register bit field definitions */
63 #define ZYNQMP_DMA_OVR_FETCH		BIT(7)
64 #define ZYNQMP_DMA_POINT_TYPE_SG	BIT(6)
65 #define ZYNQMP_DMA_RATE_CTRL_EN		BIT(3)
66 
67 /* Control 1 register bit field definitions */
68 #define ZYNQMP_DMA_SRC_ISSUE		GENMASK(4, 0)
69 
70 /* Data Attribute register bit field definitions */
71 #define ZYNQMP_DMA_ARBURST		GENMASK(27, 26)
72 #define ZYNQMP_DMA_ARCACHE		GENMASK(25, 22)
73 #define ZYNQMP_DMA_ARCACHE_OFST		22
74 #define ZYNQMP_DMA_ARQOS		GENMASK(21, 18)
75 #define ZYNQMP_DMA_ARQOS_OFST		18
76 #define ZYNQMP_DMA_ARLEN		GENMASK(17, 14)
77 #define ZYNQMP_DMA_ARLEN_OFST		14
78 #define ZYNQMP_DMA_AWBURST		GENMASK(13, 12)
79 #define ZYNQMP_DMA_AWCACHE		GENMASK(11, 8)
80 #define ZYNQMP_DMA_AWCACHE_OFST		8
81 #define ZYNQMP_DMA_AWQOS		GENMASK(7, 4)
82 #define ZYNQMP_DMA_AWQOS_OFST		4
83 #define ZYNQMP_DMA_AWLEN		GENMASK(3, 0)
84 #define ZYNQMP_DMA_AWLEN_OFST		0
85 
86 /* Descriptor Attribute register bit field definitions */
87 #define ZYNQMP_DMA_AXCOHRNT		BIT(8)
88 #define ZYNQMP_DMA_AXCACHE		GENMASK(7, 4)
89 #define ZYNQMP_DMA_AXCACHE_OFST		4
90 #define ZYNQMP_DMA_AXQOS		GENMASK(3, 0)
91 #define ZYNQMP_DMA_AXQOS_OFST		0
92 
93 /* Control register 2 bit field definitions */
94 #define ZYNQMP_DMA_ENABLE		BIT(0)
95 
96 /* Buffer Descriptor definitions */
97 #define ZYNQMP_DMA_DESC_CTRL_STOP	0x10
98 #define ZYNQMP_DMA_DESC_CTRL_COMP_INT	0x4
99 #define ZYNQMP_DMA_DESC_CTRL_SIZE_256	0x2
100 #define ZYNQMP_DMA_DESC_CTRL_COHRNT	0x1
101 
102 /* Interrupt Mask specific definitions */
103 #define ZYNQMP_DMA_INT_ERR	(ZYNQMP_DMA_AXI_RD_DATA | \
104 				ZYNQMP_DMA_AXI_WR_DATA | \
105 				ZYNQMP_DMA_AXI_RD_DST_DSCR | \
106 				ZYNQMP_DMA_AXI_RD_SRC_DSCR | \
107 				ZYNQMP_DMA_INV_APB)
108 #define ZYNQMP_DMA_INT_OVRFL	(ZYNQMP_DMA_BYTE_CNT_OVRFL | \
109 				ZYNQMP_DMA_IRQ_SRC_ACCT_ERR | \
110 				ZYNQMP_DMA_IRQ_DST_ACCT_ERR)
111 #define ZYNQMP_DMA_INT_DONE	(ZYNQMP_DMA_DONE | ZYNQMP_DMA_DST_DSCR_DONE)
112 #define ZYNQMP_DMA_INT_EN_DEFAULT_MASK	(ZYNQMP_DMA_INT_DONE | \
113 					ZYNQMP_DMA_INT_ERR | \
114 					ZYNQMP_DMA_INT_OVRFL | \
115 					ZYNQMP_DMA_DST_DSCR_DONE)
116 
117 /* Max number of descriptors per channel */
118 #define ZYNQMP_DMA_NUM_DESCS	32
119 
120 /* Max transfer size per descriptor */
121 #define ZYNQMP_DMA_MAX_TRANS_LEN	0x40000000
122 
123 /* Max burst lengths */
124 #define ZYNQMP_DMA_MAX_DST_BURST_LEN    32768U
125 #define ZYNQMP_DMA_MAX_SRC_BURST_LEN    32768U
126 
127 /* Reset values for data attributes */
128 #define ZYNQMP_DMA_AXCACHE_VAL		0xF
129 
130 #define ZYNQMP_DMA_SRC_ISSUE_RST_VAL	0x1F
131 
132 #define ZYNQMP_DMA_IDS_DEFAULT_MASK	0xFFF
133 
134 /* Bus width in bits */
135 #define ZYNQMP_DMA_BUS_WIDTH_64		64
136 #define ZYNQMP_DMA_BUS_WIDTH_128	128
137 
138 #define ZDMA_PM_TIMEOUT			100
139 
140 #define ZYNQMP_DMA_DESC_SIZE(chan)	(chan->desc_size)
141 
142 #define to_chan(chan)		container_of(chan, struct zynqmp_dma_chan, \
143 					     common)
144 #define tx_to_desc(tx)		container_of(tx, struct zynqmp_dma_desc_sw, \
145 					     async_tx)
146 
147 /**
148  * struct zynqmp_dma_desc_ll - Hw linked list descriptor
149  * @addr: Buffer address
150  * @size: Size of the buffer
151  * @ctrl: Control word
152  * @nxtdscraddr: Next descriptor base address
153  * @rsvd: Reserved field and for Hw internal use.
154  */
155 struct zynqmp_dma_desc_ll {
156 	u64 addr;
157 	u32 size;
158 	u32 ctrl;
159 	u64 nxtdscraddr;
160 	u64 rsvd;
161 };
162 
163 /**
164  * struct zynqmp_dma_desc_sw - Per Transaction structure
165  * @src: Source address for simple mode dma
166  * @dst: Destination address for simple mode dma
167  * @len: Transfer length for simple mode dma
168  * @node: Node in the channel descriptor list
169  * @tx_list: List head for the current transfer
170  * @async_tx: Async transaction descriptor
171  * @src_v: Virtual address of the src descriptor
172  * @src_p: Physical address of the src descriptor
173  * @dst_v: Virtual address of the dst descriptor
174  * @dst_p: Physical address of the dst descriptor
175  */
176 struct zynqmp_dma_desc_sw {
177 	u64 src;
178 	u64 dst;
179 	u32 len;
180 	struct list_head node;
181 	struct list_head tx_list;
182 	struct dma_async_tx_descriptor async_tx;
183 	struct zynqmp_dma_desc_ll *src_v;
184 	dma_addr_t src_p;
185 	struct zynqmp_dma_desc_ll *dst_v;
186 	dma_addr_t dst_p;
187 };
188 
189 /**
190  * struct zynqmp_dma_chan - Driver specific DMA channel structure
191  * @zdev: Driver specific device structure
192  * @regs: Control registers offset
193  * @lock: Descriptor operation lock
194  * @pending_list: Descriptors waiting
195  * @free_list: Descriptors free
196  * @active_list: Descriptors active
197  * @sw_desc_pool: SW descriptor pool
198  * @done_list: Complete descriptors
199  * @common: DMA common channel
200  * @desc_pool_v: Statically allocated descriptor base
201  * @desc_pool_p: Physical allocated descriptor base
202  * @desc_free_cnt: Descriptor available count
203  * @dev: The dma device
204  * @irq: Channel IRQ
205  * @is_dmacoherent: Tells whether dma operations are coherent or not
206  * @tasklet: Cleanup work after irq
207  * @idle : Channel status;
208  * @desc_size: Size of the low level descriptor
209  * @err: Channel has errors
210  * @bus_width: Bus width
211  * @src_burst_len: Source burst length
212  * @dst_burst_len: Dest burst length
213  */
214 struct zynqmp_dma_chan {
215 	struct zynqmp_dma_device *zdev;
216 	void __iomem *regs;
217 	spinlock_t lock;
218 	struct list_head pending_list;
219 	struct list_head free_list;
220 	struct list_head active_list;
221 	struct zynqmp_dma_desc_sw *sw_desc_pool;
222 	struct list_head done_list;
223 	struct dma_chan common;
224 	void *desc_pool_v;
225 	dma_addr_t desc_pool_p;
226 	u32 desc_free_cnt;
227 	struct device *dev;
228 	int irq;
229 	bool is_dmacoherent;
230 	struct tasklet_struct tasklet;
231 	bool idle;
232 	size_t desc_size;
233 	bool err;
234 	u32 bus_width;
235 	u32 src_burst_len;
236 	u32 dst_burst_len;
237 };
238 
239 /**
240  * struct zynqmp_dma_device - DMA device structure
241  * @dev: Device Structure
242  * @common: DMA device structure
243  * @chan: Driver specific DMA channel
244  * @clk_main: Pointer to main clock
245  * @clk_apb: Pointer to apb clock
246  */
247 struct zynqmp_dma_device {
248 	struct device *dev;
249 	struct dma_device common;
250 	struct zynqmp_dma_chan *chan;
251 	struct clk *clk_main;
252 	struct clk *clk_apb;
253 };
254 
255 static inline void zynqmp_dma_writeq(struct zynqmp_dma_chan *chan, u32 reg,
256 				     u64 value)
257 {
258 	lo_hi_writeq(value, chan->regs + reg);
259 }
260 
261 /**
262  * zynqmp_dma_update_desc_to_ctrlr - Updates descriptor to the controller
263  * @chan: ZynqMP DMA DMA channel pointer
264  * @desc: Transaction descriptor pointer
265  */
266 static void zynqmp_dma_update_desc_to_ctrlr(struct zynqmp_dma_chan *chan,
267 				      struct zynqmp_dma_desc_sw *desc)
268 {
269 	dma_addr_t addr;
270 
271 	addr = desc->src_p;
272 	zynqmp_dma_writeq(chan, ZYNQMP_DMA_SRC_START_LSB, addr);
273 	addr = desc->dst_p;
274 	zynqmp_dma_writeq(chan, ZYNQMP_DMA_DST_START_LSB, addr);
275 }
276 
277 /**
278  * zynqmp_dma_desc_config_eod - Mark the descriptor as end descriptor
279  * @chan: ZynqMP DMA channel pointer
280  * @desc: Hw descriptor pointer
281  */
282 static void zynqmp_dma_desc_config_eod(struct zynqmp_dma_chan *chan,
283 				       void *desc)
284 {
285 	struct zynqmp_dma_desc_ll *hw = (struct zynqmp_dma_desc_ll *)desc;
286 
287 	hw->ctrl |= ZYNQMP_DMA_DESC_CTRL_STOP;
288 	hw++;
289 	hw->ctrl |= ZYNQMP_DMA_DESC_CTRL_COMP_INT | ZYNQMP_DMA_DESC_CTRL_STOP;
290 }
291 
292 /**
293  * zynqmp_dma_config_sg_ll_desc - Configure the linked list descriptor
294  * @chan: ZynqMP DMA channel pointer
295  * @sdesc: Hw descriptor pointer
296  * @src: Source buffer address
297  * @dst: Destination buffer address
298  * @len: Transfer length
299  * @prev: Previous hw descriptor pointer
300  */
301 static void zynqmp_dma_config_sg_ll_desc(struct zynqmp_dma_chan *chan,
302 				   struct zynqmp_dma_desc_ll *sdesc,
303 				   dma_addr_t src, dma_addr_t dst, size_t len,
304 				   struct zynqmp_dma_desc_ll *prev)
305 {
306 	struct zynqmp_dma_desc_ll *ddesc = sdesc + 1;
307 
308 	sdesc->size = ddesc->size = len;
309 	sdesc->addr = src;
310 	ddesc->addr = dst;
311 
312 	sdesc->ctrl = ddesc->ctrl = ZYNQMP_DMA_DESC_CTRL_SIZE_256;
313 	if (chan->is_dmacoherent) {
314 		sdesc->ctrl |= ZYNQMP_DMA_DESC_CTRL_COHRNT;
315 		ddesc->ctrl |= ZYNQMP_DMA_DESC_CTRL_COHRNT;
316 	}
317 
318 	if (prev) {
319 		dma_addr_t addr = chan->desc_pool_p +
320 			    ((uintptr_t)sdesc - (uintptr_t)chan->desc_pool_v);
321 		ddesc = prev + 1;
322 		prev->nxtdscraddr = addr;
323 		ddesc->nxtdscraddr = addr + ZYNQMP_DMA_DESC_SIZE(chan);
324 	}
325 }
326 
327 /**
328  * zynqmp_dma_init - Initialize the channel
329  * @chan: ZynqMP DMA channel pointer
330  */
331 static void zynqmp_dma_init(struct zynqmp_dma_chan *chan)
332 {
333 	u32 val;
334 
335 	writel(ZYNQMP_DMA_IDS_DEFAULT_MASK, chan->regs + ZYNQMP_DMA_IDS);
336 	val = readl(chan->regs + ZYNQMP_DMA_ISR);
337 	writel(val, chan->regs + ZYNQMP_DMA_ISR);
338 
339 	if (chan->is_dmacoherent) {
340 		val = ZYNQMP_DMA_AXCOHRNT;
341 		val = (val & ~ZYNQMP_DMA_AXCACHE) |
342 			(ZYNQMP_DMA_AXCACHE_VAL << ZYNQMP_DMA_AXCACHE_OFST);
343 		writel(val, chan->regs + ZYNQMP_DMA_DSCR_ATTR);
344 	}
345 
346 	val = readl(chan->regs + ZYNQMP_DMA_DATA_ATTR);
347 	if (chan->is_dmacoherent) {
348 		val = (val & ~ZYNQMP_DMA_ARCACHE) |
349 			(ZYNQMP_DMA_AXCACHE_VAL << ZYNQMP_DMA_ARCACHE_OFST);
350 		val = (val & ~ZYNQMP_DMA_AWCACHE) |
351 			(ZYNQMP_DMA_AXCACHE_VAL << ZYNQMP_DMA_AWCACHE_OFST);
352 	}
353 	writel(val, chan->regs + ZYNQMP_DMA_DATA_ATTR);
354 
355 	/* Clearing the interrupt account rgisters */
356 	val = readl(chan->regs + ZYNQMP_DMA_IRQ_SRC_ACCT);
357 	val = readl(chan->regs + ZYNQMP_DMA_IRQ_DST_ACCT);
358 
359 	chan->idle = true;
360 }
361 
362 /**
363  * zynqmp_dma_tx_submit - Submit DMA transaction
364  * @tx: Async transaction descriptor pointer
365  *
366  * Return: cookie value
367  */
368 static dma_cookie_t zynqmp_dma_tx_submit(struct dma_async_tx_descriptor *tx)
369 {
370 	struct zynqmp_dma_chan *chan = to_chan(tx->chan);
371 	struct zynqmp_dma_desc_sw *desc, *new;
372 	dma_cookie_t cookie;
373 	unsigned long irqflags;
374 
375 	new = tx_to_desc(tx);
376 	spin_lock_irqsave(&chan->lock, irqflags);
377 	cookie = dma_cookie_assign(tx);
378 
379 	if (!list_empty(&chan->pending_list)) {
380 		desc = list_last_entry(&chan->pending_list,
381 				     struct zynqmp_dma_desc_sw, node);
382 		if (!list_empty(&desc->tx_list))
383 			desc = list_last_entry(&desc->tx_list,
384 					       struct zynqmp_dma_desc_sw, node);
385 		desc->src_v->nxtdscraddr = new->src_p;
386 		desc->src_v->ctrl &= ~ZYNQMP_DMA_DESC_CTRL_STOP;
387 		desc->dst_v->nxtdscraddr = new->dst_p;
388 		desc->dst_v->ctrl &= ~ZYNQMP_DMA_DESC_CTRL_STOP;
389 	}
390 
391 	list_add_tail(&new->node, &chan->pending_list);
392 	spin_unlock_irqrestore(&chan->lock, irqflags);
393 
394 	return cookie;
395 }
396 
397 /**
398  * zynqmp_dma_get_descriptor - Get the sw descriptor from the pool
399  * @chan: ZynqMP DMA channel pointer
400  *
401  * Return: The sw descriptor
402  */
403 static struct zynqmp_dma_desc_sw *
404 zynqmp_dma_get_descriptor(struct zynqmp_dma_chan *chan)
405 {
406 	struct zynqmp_dma_desc_sw *desc;
407 	unsigned long irqflags;
408 
409 	spin_lock_irqsave(&chan->lock, irqflags);
410 	desc = list_first_entry(&chan->free_list,
411 				struct zynqmp_dma_desc_sw, node);
412 	list_del(&desc->node);
413 	spin_unlock_irqrestore(&chan->lock, irqflags);
414 
415 	INIT_LIST_HEAD(&desc->tx_list);
416 	/* Clear the src and dst descriptor memory */
417 	memset((void *)desc->src_v, 0, ZYNQMP_DMA_DESC_SIZE(chan));
418 	memset((void *)desc->dst_v, 0, ZYNQMP_DMA_DESC_SIZE(chan));
419 
420 	return desc;
421 }
422 
423 /**
424  * zynqmp_dma_free_descriptor - Issue pending transactions
425  * @chan: ZynqMP DMA channel pointer
426  * @sdesc: Transaction descriptor pointer
427  */
428 static void zynqmp_dma_free_descriptor(struct zynqmp_dma_chan *chan,
429 				 struct zynqmp_dma_desc_sw *sdesc)
430 {
431 	struct zynqmp_dma_desc_sw *child, *next;
432 
433 	chan->desc_free_cnt++;
434 	list_move_tail(&sdesc->node, &chan->free_list);
435 	list_for_each_entry_safe(child, next, &sdesc->tx_list, node) {
436 		chan->desc_free_cnt++;
437 		list_move_tail(&child->node, &chan->free_list);
438 	}
439 }
440 
441 /**
442  * zynqmp_dma_free_desc_list - Free descriptors list
443  * @chan: ZynqMP DMA channel pointer
444  * @list: List to parse and delete the descriptor
445  */
446 static void zynqmp_dma_free_desc_list(struct zynqmp_dma_chan *chan,
447 				      struct list_head *list)
448 {
449 	struct zynqmp_dma_desc_sw *desc, *next;
450 
451 	list_for_each_entry_safe(desc, next, list, node)
452 		zynqmp_dma_free_descriptor(chan, desc);
453 }
454 
455 /**
456  * zynqmp_dma_alloc_chan_resources - Allocate channel resources
457  * @dchan: DMA channel
458  *
459  * Return: Number of descriptors on success and failure value on error
460  */
461 static int zynqmp_dma_alloc_chan_resources(struct dma_chan *dchan)
462 {
463 	struct zynqmp_dma_chan *chan = to_chan(dchan);
464 	struct zynqmp_dma_desc_sw *desc;
465 	int i, ret;
466 
467 	ret = pm_runtime_resume_and_get(chan->dev);
468 	if (ret < 0)
469 		return ret;
470 
471 	chan->sw_desc_pool = kcalloc(ZYNQMP_DMA_NUM_DESCS, sizeof(*desc),
472 				     GFP_KERNEL);
473 	if (!chan->sw_desc_pool)
474 		return -ENOMEM;
475 
476 	chan->idle = true;
477 	chan->desc_free_cnt = ZYNQMP_DMA_NUM_DESCS;
478 
479 	INIT_LIST_HEAD(&chan->free_list);
480 
481 	for (i = 0; i < ZYNQMP_DMA_NUM_DESCS; i++) {
482 		desc = chan->sw_desc_pool + i;
483 		dma_async_tx_descriptor_init(&desc->async_tx, &chan->common);
484 		desc->async_tx.tx_submit = zynqmp_dma_tx_submit;
485 		list_add_tail(&desc->node, &chan->free_list);
486 	}
487 
488 	chan->desc_pool_v = dma_alloc_coherent(chan->dev,
489 					       (2 * ZYNQMP_DMA_DESC_SIZE(chan) *
490 					       ZYNQMP_DMA_NUM_DESCS),
491 					       &chan->desc_pool_p, GFP_KERNEL);
492 	if (!chan->desc_pool_v)
493 		return -ENOMEM;
494 
495 	for (i = 0; i < ZYNQMP_DMA_NUM_DESCS; i++) {
496 		desc = chan->sw_desc_pool + i;
497 		desc->src_v = (struct zynqmp_dma_desc_ll *) (chan->desc_pool_v +
498 					(i * ZYNQMP_DMA_DESC_SIZE(chan) * 2));
499 		desc->dst_v = (struct zynqmp_dma_desc_ll *) (desc->src_v + 1);
500 		desc->src_p = chan->desc_pool_p +
501 				(i * ZYNQMP_DMA_DESC_SIZE(chan) * 2);
502 		desc->dst_p = desc->src_p + ZYNQMP_DMA_DESC_SIZE(chan);
503 	}
504 
505 	return ZYNQMP_DMA_NUM_DESCS;
506 }
507 
508 /**
509  * zynqmp_dma_start - Start DMA channel
510  * @chan: ZynqMP DMA channel pointer
511  */
512 static void zynqmp_dma_start(struct zynqmp_dma_chan *chan)
513 {
514 	writel(ZYNQMP_DMA_INT_EN_DEFAULT_MASK, chan->regs + ZYNQMP_DMA_IER);
515 	writel(0, chan->regs + ZYNQMP_DMA_TOTAL_BYTE);
516 	chan->idle = false;
517 	writel(ZYNQMP_DMA_ENABLE, chan->regs + ZYNQMP_DMA_CTRL2);
518 }
519 
520 /**
521  * zynqmp_dma_handle_ovfl_int - Process the overflow interrupt
522  * @chan: ZynqMP DMA channel pointer
523  * @status: Interrupt status value
524  */
525 static void zynqmp_dma_handle_ovfl_int(struct zynqmp_dma_chan *chan, u32 status)
526 {
527 	if (status & ZYNQMP_DMA_BYTE_CNT_OVRFL)
528 		writel(0, chan->regs + ZYNQMP_DMA_TOTAL_BYTE);
529 	if (status & ZYNQMP_DMA_IRQ_DST_ACCT_ERR)
530 		readl(chan->regs + ZYNQMP_DMA_IRQ_DST_ACCT);
531 	if (status & ZYNQMP_DMA_IRQ_SRC_ACCT_ERR)
532 		readl(chan->regs + ZYNQMP_DMA_IRQ_SRC_ACCT);
533 }
534 
535 static void zynqmp_dma_config(struct zynqmp_dma_chan *chan)
536 {
537 	u32 val, burst_val;
538 
539 	val = readl(chan->regs + ZYNQMP_DMA_CTRL0);
540 	val |= ZYNQMP_DMA_POINT_TYPE_SG;
541 	writel(val, chan->regs + ZYNQMP_DMA_CTRL0);
542 
543 	val = readl(chan->regs + ZYNQMP_DMA_DATA_ATTR);
544 	burst_val = __ilog2_u32(chan->src_burst_len);
545 	val = (val & ~ZYNQMP_DMA_ARLEN) |
546 		((burst_val << ZYNQMP_DMA_ARLEN_OFST) & ZYNQMP_DMA_ARLEN);
547 	burst_val = __ilog2_u32(chan->dst_burst_len);
548 	val = (val & ~ZYNQMP_DMA_AWLEN) |
549 		((burst_val << ZYNQMP_DMA_AWLEN_OFST) & ZYNQMP_DMA_AWLEN);
550 	writel(val, chan->regs + ZYNQMP_DMA_DATA_ATTR);
551 }
552 
553 /**
554  * zynqmp_dma_device_config - Zynqmp dma device configuration
555  * @dchan: DMA channel
556  * @config: DMA device config
557  *
558  * Return: 0 always
559  */
560 static int zynqmp_dma_device_config(struct dma_chan *dchan,
561 				    struct dma_slave_config *config)
562 {
563 	struct zynqmp_dma_chan *chan = to_chan(dchan);
564 
565 	chan->src_burst_len = clamp(config->src_maxburst, 1U,
566 		ZYNQMP_DMA_MAX_SRC_BURST_LEN);
567 	chan->dst_burst_len = clamp(config->dst_maxburst, 1U,
568 		ZYNQMP_DMA_MAX_DST_BURST_LEN);
569 
570 	return 0;
571 }
572 
573 /**
574  * zynqmp_dma_start_transfer - Initiate the new transfer
575  * @chan: ZynqMP DMA channel pointer
576  */
577 static void zynqmp_dma_start_transfer(struct zynqmp_dma_chan *chan)
578 {
579 	struct zynqmp_dma_desc_sw *desc;
580 
581 	if (!chan->idle)
582 		return;
583 
584 	zynqmp_dma_config(chan);
585 
586 	desc = list_first_entry_or_null(&chan->pending_list,
587 					struct zynqmp_dma_desc_sw, node);
588 	if (!desc)
589 		return;
590 
591 	list_splice_tail_init(&chan->pending_list, &chan->active_list);
592 	zynqmp_dma_update_desc_to_ctrlr(chan, desc);
593 	zynqmp_dma_start(chan);
594 }
595 
596 
597 /**
598  * zynqmp_dma_chan_desc_cleanup - Cleanup the completed descriptors
599  * @chan: ZynqMP DMA channel
600  */
601 static void zynqmp_dma_chan_desc_cleanup(struct zynqmp_dma_chan *chan)
602 {
603 	struct zynqmp_dma_desc_sw *desc, *next;
604 	unsigned long irqflags;
605 
606 	spin_lock_irqsave(&chan->lock, irqflags);
607 
608 	list_for_each_entry_safe(desc, next, &chan->done_list, node) {
609 		struct dmaengine_desc_callback cb;
610 
611 		dmaengine_desc_get_callback(&desc->async_tx, &cb);
612 		if (dmaengine_desc_callback_valid(&cb)) {
613 			spin_unlock_irqrestore(&chan->lock, irqflags);
614 			dmaengine_desc_callback_invoke(&cb, NULL);
615 			spin_lock_irqsave(&chan->lock, irqflags);
616 		}
617 
618 		/* Run any dependencies, then free the descriptor */
619 		zynqmp_dma_free_descriptor(chan, desc);
620 	}
621 
622 	spin_unlock_irqrestore(&chan->lock, irqflags);
623 }
624 
625 /**
626  * zynqmp_dma_complete_descriptor - Mark the active descriptor as complete
627  * @chan: ZynqMP DMA channel pointer
628  */
629 static void zynqmp_dma_complete_descriptor(struct zynqmp_dma_chan *chan)
630 {
631 	struct zynqmp_dma_desc_sw *desc;
632 
633 	desc = list_first_entry_or_null(&chan->active_list,
634 					struct zynqmp_dma_desc_sw, node);
635 	if (!desc)
636 		return;
637 	list_del(&desc->node);
638 	dma_cookie_complete(&desc->async_tx);
639 	list_add_tail(&desc->node, &chan->done_list);
640 }
641 
642 /**
643  * zynqmp_dma_issue_pending - Issue pending transactions
644  * @dchan: DMA channel pointer
645  */
646 static void zynqmp_dma_issue_pending(struct dma_chan *dchan)
647 {
648 	struct zynqmp_dma_chan *chan = to_chan(dchan);
649 	unsigned long irqflags;
650 
651 	spin_lock_irqsave(&chan->lock, irqflags);
652 	zynqmp_dma_start_transfer(chan);
653 	spin_unlock_irqrestore(&chan->lock, irqflags);
654 }
655 
656 /**
657  * zynqmp_dma_free_descriptors - Free channel descriptors
658  * @chan: ZynqMP DMA channel pointer
659  */
660 static void zynqmp_dma_free_descriptors(struct zynqmp_dma_chan *chan)
661 {
662 	unsigned long irqflags;
663 
664 	spin_lock_irqsave(&chan->lock, irqflags);
665 	zynqmp_dma_free_desc_list(chan, &chan->active_list);
666 	zynqmp_dma_free_desc_list(chan, &chan->pending_list);
667 	zynqmp_dma_free_desc_list(chan, &chan->done_list);
668 	spin_unlock_irqrestore(&chan->lock, irqflags);
669 }
670 
671 /**
672  * zynqmp_dma_free_chan_resources - Free channel resources
673  * @dchan: DMA channel pointer
674  */
675 static void zynqmp_dma_free_chan_resources(struct dma_chan *dchan)
676 {
677 	struct zynqmp_dma_chan *chan = to_chan(dchan);
678 
679 	zynqmp_dma_free_descriptors(chan);
680 	dma_free_coherent(chan->dev,
681 		(2 * ZYNQMP_DMA_DESC_SIZE(chan) * ZYNQMP_DMA_NUM_DESCS),
682 		chan->desc_pool_v, chan->desc_pool_p);
683 	kfree(chan->sw_desc_pool);
684 	pm_runtime_mark_last_busy(chan->dev);
685 	pm_runtime_put_autosuspend(chan->dev);
686 }
687 
688 /**
689  * zynqmp_dma_reset - Reset the channel
690  * @chan: ZynqMP DMA channel pointer
691  */
692 static void zynqmp_dma_reset(struct zynqmp_dma_chan *chan)
693 {
694 	unsigned long irqflags;
695 
696 	writel(ZYNQMP_DMA_IDS_DEFAULT_MASK, chan->regs + ZYNQMP_DMA_IDS);
697 
698 	spin_lock_irqsave(&chan->lock, irqflags);
699 	zynqmp_dma_complete_descriptor(chan);
700 	spin_unlock_irqrestore(&chan->lock, irqflags);
701 	zynqmp_dma_chan_desc_cleanup(chan);
702 	zynqmp_dma_free_descriptors(chan);
703 
704 	zynqmp_dma_init(chan);
705 }
706 
707 /**
708  * zynqmp_dma_irq_handler - ZynqMP DMA Interrupt handler
709  * @irq: IRQ number
710  * @data: Pointer to the ZynqMP DMA channel structure
711  *
712  * Return: IRQ_HANDLED/IRQ_NONE
713  */
714 static irqreturn_t zynqmp_dma_irq_handler(int irq, void *data)
715 {
716 	struct zynqmp_dma_chan *chan = (struct zynqmp_dma_chan *)data;
717 	u32 isr, imr, status;
718 	irqreturn_t ret = IRQ_NONE;
719 
720 	isr = readl(chan->regs + ZYNQMP_DMA_ISR);
721 	imr = readl(chan->regs + ZYNQMP_DMA_IMR);
722 	status = isr & ~imr;
723 
724 	writel(isr, chan->regs + ZYNQMP_DMA_ISR);
725 	if (status & ZYNQMP_DMA_INT_DONE) {
726 		tasklet_schedule(&chan->tasklet);
727 		ret = IRQ_HANDLED;
728 	}
729 
730 	if (status & ZYNQMP_DMA_DONE)
731 		chan->idle = true;
732 
733 	if (status & ZYNQMP_DMA_INT_ERR) {
734 		chan->err = true;
735 		tasklet_schedule(&chan->tasklet);
736 		dev_err(chan->dev, "Channel %p has errors\n", chan);
737 		ret = IRQ_HANDLED;
738 	}
739 
740 	if (status & ZYNQMP_DMA_INT_OVRFL) {
741 		zynqmp_dma_handle_ovfl_int(chan, status);
742 		dev_dbg(chan->dev, "Channel %p overflow interrupt\n", chan);
743 		ret = IRQ_HANDLED;
744 	}
745 
746 	return ret;
747 }
748 
749 /**
750  * zynqmp_dma_do_tasklet - Schedule completion tasklet
751  * @t: Pointer to the ZynqMP DMA channel structure
752  */
753 static void zynqmp_dma_do_tasklet(struct tasklet_struct *t)
754 {
755 	struct zynqmp_dma_chan *chan = from_tasklet(chan, t, tasklet);
756 	u32 count;
757 	unsigned long irqflags;
758 
759 	if (chan->err) {
760 		zynqmp_dma_reset(chan);
761 		chan->err = false;
762 		return;
763 	}
764 
765 	spin_lock_irqsave(&chan->lock, irqflags);
766 	count = readl(chan->regs + ZYNQMP_DMA_IRQ_DST_ACCT);
767 	while (count) {
768 		zynqmp_dma_complete_descriptor(chan);
769 		count--;
770 	}
771 	spin_unlock_irqrestore(&chan->lock, irqflags);
772 
773 	zynqmp_dma_chan_desc_cleanup(chan);
774 
775 	if (chan->idle) {
776 		spin_lock_irqsave(&chan->lock, irqflags);
777 		zynqmp_dma_start_transfer(chan);
778 		spin_unlock_irqrestore(&chan->lock, irqflags);
779 	}
780 }
781 
782 /**
783  * zynqmp_dma_device_terminate_all - Aborts all transfers on a channel
784  * @dchan: DMA channel pointer
785  *
786  * Return: Always '0'
787  */
788 static int zynqmp_dma_device_terminate_all(struct dma_chan *dchan)
789 {
790 	struct zynqmp_dma_chan *chan = to_chan(dchan);
791 
792 	writel(ZYNQMP_DMA_IDS_DEFAULT_MASK, chan->regs + ZYNQMP_DMA_IDS);
793 	zynqmp_dma_free_descriptors(chan);
794 
795 	return 0;
796 }
797 
798 /**
799  * zynqmp_dma_synchronize - Synchronizes the termination of a transfers to the current context.
800  * @dchan: DMA channel pointer
801  */
802 static void zynqmp_dma_synchronize(struct dma_chan *dchan)
803 {
804 	struct zynqmp_dma_chan *chan = to_chan(dchan);
805 
806 	tasklet_kill(&chan->tasklet);
807 }
808 
809 /**
810  * zynqmp_dma_prep_memcpy - prepare descriptors for memcpy transaction
811  * @dchan: DMA channel
812  * @dma_dst: Destination buffer address
813  * @dma_src: Source buffer address
814  * @len: Transfer length
815  * @flags: transfer ack flags
816  *
817  * Return: Async transaction descriptor on success and NULL on failure
818  */
819 static struct dma_async_tx_descriptor *zynqmp_dma_prep_memcpy(
820 				struct dma_chan *dchan, dma_addr_t dma_dst,
821 				dma_addr_t dma_src, size_t len, ulong flags)
822 {
823 	struct zynqmp_dma_chan *chan;
824 	struct zynqmp_dma_desc_sw *new, *first = NULL;
825 	void *desc = NULL, *prev = NULL;
826 	size_t copy;
827 	u32 desc_cnt;
828 	unsigned long irqflags;
829 
830 	chan = to_chan(dchan);
831 
832 	desc_cnt = DIV_ROUND_UP(len, ZYNQMP_DMA_MAX_TRANS_LEN);
833 
834 	spin_lock_irqsave(&chan->lock, irqflags);
835 	if (desc_cnt > chan->desc_free_cnt) {
836 		spin_unlock_irqrestore(&chan->lock, irqflags);
837 		dev_dbg(chan->dev, "chan %p descs are not available\n", chan);
838 		return NULL;
839 	}
840 	chan->desc_free_cnt = chan->desc_free_cnt - desc_cnt;
841 	spin_unlock_irqrestore(&chan->lock, irqflags);
842 
843 	do {
844 		/* Allocate and populate the descriptor */
845 		new = zynqmp_dma_get_descriptor(chan);
846 
847 		copy = min_t(size_t, len, ZYNQMP_DMA_MAX_TRANS_LEN);
848 		desc = (struct zynqmp_dma_desc_ll *)new->src_v;
849 		zynqmp_dma_config_sg_ll_desc(chan, desc, dma_src,
850 					     dma_dst, copy, prev);
851 		prev = desc;
852 		len -= copy;
853 		dma_src += copy;
854 		dma_dst += copy;
855 		if (!first)
856 			first = new;
857 		else
858 			list_add_tail(&new->node, &first->tx_list);
859 	} while (len);
860 
861 	zynqmp_dma_desc_config_eod(chan, desc);
862 	async_tx_ack(&first->async_tx);
863 	first->async_tx.flags = (enum dma_ctrl_flags)flags;
864 	return &first->async_tx;
865 }
866 
867 /**
868  * zynqmp_dma_chan_remove - Channel remove function
869  * @chan: ZynqMP DMA channel pointer
870  */
871 static void zynqmp_dma_chan_remove(struct zynqmp_dma_chan *chan)
872 {
873 	if (!chan)
874 		return;
875 
876 	if (chan->irq)
877 		devm_free_irq(chan->zdev->dev, chan->irq, chan);
878 	tasklet_kill(&chan->tasklet);
879 	list_del(&chan->common.device_node);
880 }
881 
882 /**
883  * zynqmp_dma_chan_probe - Per Channel Probing
884  * @zdev: Driver specific device structure
885  * @pdev: Pointer to the platform_device structure
886  *
887  * Return: '0' on success and failure value on error
888  */
889 static int zynqmp_dma_chan_probe(struct zynqmp_dma_device *zdev,
890 			   struct platform_device *pdev)
891 {
892 	struct zynqmp_dma_chan *chan;
893 	struct resource *res;
894 	struct device_node *node = pdev->dev.of_node;
895 	int err;
896 
897 	chan = devm_kzalloc(zdev->dev, sizeof(*chan), GFP_KERNEL);
898 	if (!chan)
899 		return -ENOMEM;
900 	chan->dev = zdev->dev;
901 	chan->zdev = zdev;
902 
903 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
904 	chan->regs = devm_ioremap_resource(&pdev->dev, res);
905 	if (IS_ERR(chan->regs))
906 		return PTR_ERR(chan->regs);
907 
908 	chan->bus_width = ZYNQMP_DMA_BUS_WIDTH_64;
909 	chan->dst_burst_len = ZYNQMP_DMA_MAX_DST_BURST_LEN;
910 	chan->src_burst_len = ZYNQMP_DMA_MAX_SRC_BURST_LEN;
911 	err = of_property_read_u32(node, "xlnx,bus-width", &chan->bus_width);
912 	if (err < 0) {
913 		dev_err(&pdev->dev, "missing xlnx,bus-width property\n");
914 		return err;
915 	}
916 
917 	if (chan->bus_width != ZYNQMP_DMA_BUS_WIDTH_64 &&
918 	    chan->bus_width != ZYNQMP_DMA_BUS_WIDTH_128) {
919 		dev_err(zdev->dev, "invalid bus-width value");
920 		return -EINVAL;
921 	}
922 
923 	chan->is_dmacoherent =  of_property_read_bool(node, "dma-coherent");
924 	zdev->chan = chan;
925 	tasklet_setup(&chan->tasklet, zynqmp_dma_do_tasklet);
926 	spin_lock_init(&chan->lock);
927 	INIT_LIST_HEAD(&chan->active_list);
928 	INIT_LIST_HEAD(&chan->pending_list);
929 	INIT_LIST_HEAD(&chan->done_list);
930 	INIT_LIST_HEAD(&chan->free_list);
931 
932 	dma_cookie_init(&chan->common);
933 	chan->common.device = &zdev->common;
934 	list_add_tail(&chan->common.device_node, &zdev->common.channels);
935 
936 	zynqmp_dma_init(chan);
937 	chan->irq = platform_get_irq(pdev, 0);
938 	if (chan->irq < 0)
939 		return -ENXIO;
940 	err = devm_request_irq(&pdev->dev, chan->irq, zynqmp_dma_irq_handler, 0,
941 			       "zynqmp-dma", chan);
942 	if (err)
943 		return err;
944 
945 	chan->desc_size = sizeof(struct zynqmp_dma_desc_ll);
946 	chan->idle = true;
947 	return 0;
948 }
949 
950 /**
951  * of_zynqmp_dma_xlate - Translation function
952  * @dma_spec: Pointer to DMA specifier as found in the device tree
953  * @ofdma: Pointer to DMA controller data
954  *
955  * Return: DMA channel pointer on success and NULL on error
956  */
957 static struct dma_chan *of_zynqmp_dma_xlate(struct of_phandle_args *dma_spec,
958 					    struct of_dma *ofdma)
959 {
960 	struct zynqmp_dma_device *zdev = ofdma->of_dma_data;
961 
962 	return dma_get_slave_channel(&zdev->chan->common);
963 }
964 
965 /**
966  * zynqmp_dma_suspend - Suspend method for the driver
967  * @dev:	Address of the device structure
968  *
969  * Put the driver into low power mode.
970  * Return: 0 on success and failure value on error
971  */
972 static int __maybe_unused zynqmp_dma_suspend(struct device *dev)
973 {
974 	if (!device_may_wakeup(dev))
975 		return pm_runtime_force_suspend(dev);
976 
977 	return 0;
978 }
979 
980 /**
981  * zynqmp_dma_resume - Resume from suspend
982  * @dev:	Address of the device structure
983  *
984  * Resume operation after suspend.
985  * Return: 0 on success and failure value on error
986  */
987 static int __maybe_unused zynqmp_dma_resume(struct device *dev)
988 {
989 	if (!device_may_wakeup(dev))
990 		return pm_runtime_force_resume(dev);
991 
992 	return 0;
993 }
994 
995 /**
996  * zynqmp_dma_runtime_suspend - Runtime suspend method for the driver
997  * @dev:	Address of the device structure
998  *
999  * Put the driver into low power mode.
1000  * Return: 0 always
1001  */
1002 static int __maybe_unused zynqmp_dma_runtime_suspend(struct device *dev)
1003 {
1004 	struct zynqmp_dma_device *zdev = dev_get_drvdata(dev);
1005 
1006 	clk_disable_unprepare(zdev->clk_main);
1007 	clk_disable_unprepare(zdev->clk_apb);
1008 
1009 	return 0;
1010 }
1011 
1012 /**
1013  * zynqmp_dma_runtime_resume - Runtime suspend method for the driver
1014  * @dev:	Address of the device structure
1015  *
1016  * Put the driver into low power mode.
1017  * Return: 0 always
1018  */
1019 static int __maybe_unused zynqmp_dma_runtime_resume(struct device *dev)
1020 {
1021 	struct zynqmp_dma_device *zdev = dev_get_drvdata(dev);
1022 	int err;
1023 
1024 	err = clk_prepare_enable(zdev->clk_main);
1025 	if (err) {
1026 		dev_err(dev, "Unable to enable main clock.\n");
1027 		return err;
1028 	}
1029 
1030 	err = clk_prepare_enable(zdev->clk_apb);
1031 	if (err) {
1032 		dev_err(dev, "Unable to enable apb clock.\n");
1033 		clk_disable_unprepare(zdev->clk_main);
1034 		return err;
1035 	}
1036 
1037 	return 0;
1038 }
1039 
1040 static const struct dev_pm_ops zynqmp_dma_dev_pm_ops = {
1041 	SET_SYSTEM_SLEEP_PM_OPS(zynqmp_dma_suspend, zynqmp_dma_resume)
1042 	SET_RUNTIME_PM_OPS(zynqmp_dma_runtime_suspend,
1043 			   zynqmp_dma_runtime_resume, NULL)
1044 };
1045 
1046 /**
1047  * zynqmp_dma_probe - Driver probe function
1048  * @pdev: Pointer to the platform_device structure
1049  *
1050  * Return: '0' on success and failure value on error
1051  */
1052 static int zynqmp_dma_probe(struct platform_device *pdev)
1053 {
1054 	struct zynqmp_dma_device *zdev;
1055 	struct dma_device *p;
1056 	int ret;
1057 
1058 	zdev = devm_kzalloc(&pdev->dev, sizeof(*zdev), GFP_KERNEL);
1059 	if (!zdev)
1060 		return -ENOMEM;
1061 
1062 	zdev->dev = &pdev->dev;
1063 	INIT_LIST_HEAD(&zdev->common.channels);
1064 
1065 	dma_set_mask(&pdev->dev, DMA_BIT_MASK(44));
1066 	dma_cap_set(DMA_MEMCPY, zdev->common.cap_mask);
1067 
1068 	p = &zdev->common;
1069 	p->device_prep_dma_memcpy = zynqmp_dma_prep_memcpy;
1070 	p->device_terminate_all = zynqmp_dma_device_terminate_all;
1071 	p->device_synchronize = zynqmp_dma_synchronize;
1072 	p->device_issue_pending = zynqmp_dma_issue_pending;
1073 	p->device_alloc_chan_resources = zynqmp_dma_alloc_chan_resources;
1074 	p->device_free_chan_resources = zynqmp_dma_free_chan_resources;
1075 	p->device_tx_status = dma_cookie_status;
1076 	p->device_config = zynqmp_dma_device_config;
1077 	p->dev = &pdev->dev;
1078 
1079 	zdev->clk_main = devm_clk_get(&pdev->dev, "clk_main");
1080 	if (IS_ERR(zdev->clk_main))
1081 		return dev_err_probe(&pdev->dev, PTR_ERR(zdev->clk_main),
1082 				     "main clock not found.\n");
1083 
1084 	zdev->clk_apb = devm_clk_get(&pdev->dev, "clk_apb");
1085 	if (IS_ERR(zdev->clk_apb))
1086 		return dev_err_probe(&pdev->dev, PTR_ERR(zdev->clk_apb),
1087 				     "apb clock not found.\n");
1088 
1089 	platform_set_drvdata(pdev, zdev);
1090 	pm_runtime_set_autosuspend_delay(zdev->dev, ZDMA_PM_TIMEOUT);
1091 	pm_runtime_use_autosuspend(zdev->dev);
1092 	pm_runtime_enable(zdev->dev);
1093 	ret = pm_runtime_resume_and_get(zdev->dev);
1094 	if (ret < 0) {
1095 		dev_err(&pdev->dev, "device wakeup failed.\n");
1096 		pm_runtime_disable(zdev->dev);
1097 	}
1098 	if (!pm_runtime_enabled(zdev->dev)) {
1099 		ret = zynqmp_dma_runtime_resume(zdev->dev);
1100 		if (ret)
1101 			return ret;
1102 	}
1103 
1104 	ret = zynqmp_dma_chan_probe(zdev, pdev);
1105 	if (ret) {
1106 		dev_err_probe(&pdev->dev, ret, "Probing channel failed\n");
1107 		goto err_disable_pm;
1108 	}
1109 
1110 	p->dst_addr_widths = BIT(zdev->chan->bus_width / 8);
1111 	p->src_addr_widths = BIT(zdev->chan->bus_width / 8);
1112 
1113 	ret = dma_async_device_register(&zdev->common);
1114 	if (ret) {
1115 		dev_err(zdev->dev, "failed to register the dma device\n");
1116 		goto free_chan_resources;
1117 	}
1118 
1119 	ret = of_dma_controller_register(pdev->dev.of_node,
1120 					 of_zynqmp_dma_xlate, zdev);
1121 	if (ret) {
1122 		dev_err_probe(&pdev->dev, ret, "Unable to register DMA to DT\n");
1123 		dma_async_device_unregister(&zdev->common);
1124 		goto free_chan_resources;
1125 	}
1126 
1127 	pm_runtime_mark_last_busy(zdev->dev);
1128 	pm_runtime_put_sync_autosuspend(zdev->dev);
1129 
1130 	return 0;
1131 
1132 free_chan_resources:
1133 	zynqmp_dma_chan_remove(zdev->chan);
1134 err_disable_pm:
1135 	if (!pm_runtime_enabled(zdev->dev))
1136 		zynqmp_dma_runtime_suspend(zdev->dev);
1137 	pm_runtime_disable(zdev->dev);
1138 	return ret;
1139 }
1140 
1141 /**
1142  * zynqmp_dma_remove - Driver remove function
1143  * @pdev: Pointer to the platform_device structure
1144  *
1145  * Return: Always '0'
1146  */
1147 static int zynqmp_dma_remove(struct platform_device *pdev)
1148 {
1149 	struct zynqmp_dma_device *zdev = platform_get_drvdata(pdev);
1150 
1151 	of_dma_controller_free(pdev->dev.of_node);
1152 	dma_async_device_unregister(&zdev->common);
1153 
1154 	zynqmp_dma_chan_remove(zdev->chan);
1155 	pm_runtime_disable(zdev->dev);
1156 	if (!pm_runtime_enabled(zdev->dev))
1157 		zynqmp_dma_runtime_suspend(zdev->dev);
1158 
1159 	return 0;
1160 }
1161 
1162 static const struct of_device_id zynqmp_dma_of_match[] = {
1163 	{ .compatible = "xlnx,zynqmp-dma-1.0", },
1164 	{}
1165 };
1166 MODULE_DEVICE_TABLE(of, zynqmp_dma_of_match);
1167 
1168 static struct platform_driver zynqmp_dma_driver = {
1169 	.driver = {
1170 		.name = "xilinx-zynqmp-dma",
1171 		.of_match_table = zynqmp_dma_of_match,
1172 		.pm = &zynqmp_dma_dev_pm_ops,
1173 	},
1174 	.probe = zynqmp_dma_probe,
1175 	.remove = zynqmp_dma_remove,
1176 };
1177 
1178 module_platform_driver(zynqmp_dma_driver);
1179 
1180 MODULE_LICENSE("GPL");
1181 MODULE_AUTHOR("Xilinx, Inc.");
1182 MODULE_DESCRIPTION("Xilinx ZynqMP DMA driver");
1183