2 * Copyright (C) 2017 Spreadtrum Communications Inc.
4 * SPDX-License-Identifier: GPL-2.0
8 #include <linux/dma-mapping.h>
9 #include <linux/dma/sprd-dma.h>
10 #include <linux/errno.h>
11 #include <linux/init.h>
12 #include <linux/interrupt.h>
14 #include <linux/kernel.h>
15 #include <linux/module.h>
17 #include <linux/of_dma.h>
18 #include <linux/of_device.h>
19 #include <linux/pm_runtime.h>
20 #include <linux/slab.h>
24 #define SPRD_DMA_CHN_REG_OFFSET 0x1000
25 #define SPRD_DMA_CHN_REG_LENGTH 0x40
26 #define SPRD_DMA_MEMCPY_MIN_SIZE 64
28 /* DMA global registers definition */
29 #define SPRD_DMA_GLB_PAUSE 0x0
30 #define SPRD_DMA_GLB_FRAG_WAIT 0x4
31 #define SPRD_DMA_GLB_REQ_PEND0_EN 0x8
32 #define SPRD_DMA_GLB_REQ_PEND1_EN 0xc
33 #define SPRD_DMA_GLB_INT_RAW_STS 0x10
34 #define SPRD_DMA_GLB_INT_MSK_STS 0x14
35 #define SPRD_DMA_GLB_REQ_STS 0x18
36 #define SPRD_DMA_GLB_CHN_EN_STS 0x1c
37 #define SPRD_DMA_GLB_DEBUG_STS 0x20
38 #define SPRD_DMA_GLB_ARB_SEL_STS 0x24
39 #define SPRD_DMA_GLB_REQ_UID(uid) (0x4 * ((uid) - 1))
40 #define SPRD_DMA_GLB_REQ_UID_OFFSET 0x2000
42 /* DMA channel registers definition */
43 #define SPRD_DMA_CHN_PAUSE 0x0
44 #define SPRD_DMA_CHN_REQ 0x4
45 #define SPRD_DMA_CHN_CFG 0x8
46 #define SPRD_DMA_CHN_INTC 0xc
47 #define SPRD_DMA_CHN_SRC_ADDR 0x10
48 #define SPRD_DMA_CHN_DES_ADDR 0x14
49 #define SPRD_DMA_CHN_FRG_LEN 0x18
50 #define SPRD_DMA_CHN_BLK_LEN 0x1c
51 #define SPRD_DMA_CHN_TRSC_LEN 0x20
52 #define SPRD_DMA_CHN_TRSF_STEP 0x24
53 #define SPRD_DMA_CHN_WARP_PTR 0x28
54 #define SPRD_DMA_CHN_WARP_TO 0x2c
55 #define SPRD_DMA_CHN_LLIST_PTR 0x30
56 #define SPRD_DMA_CHN_FRAG_STEP 0x34
57 #define SPRD_DMA_CHN_SRC_BLK_STEP 0x38
58 #define SPRD_DMA_CHN_DES_BLK_STEP 0x3c
60 /* SPRD_DMA_CHN_INTC register definition */
61 #define SPRD_DMA_INT_MASK GENMASK(4, 0)
62 #define SPRD_DMA_INT_CLR_OFFSET 24
63 #define SPRD_DMA_FRAG_INT_EN BIT(0)
64 #define SPRD_DMA_BLK_INT_EN BIT(1)
65 #define SPRD_DMA_TRANS_INT_EN BIT(2)
66 #define SPRD_DMA_LIST_INT_EN BIT(3)
67 #define SPRD_DMA_CFG_ERR_INT_EN BIT(4)
69 /* SPRD_DMA_CHN_CFG register definition */
70 #define SPRD_DMA_CHN_EN BIT(0)
71 #define SPRD_DMA_LINKLIST_EN BIT(4)
72 #define SPRD_DMA_WAIT_BDONE_OFFSET 24
73 #define SPRD_DMA_DONOT_WAIT_BDONE 1
75 /* SPRD_DMA_CHN_REQ register definition */
76 #define SPRD_DMA_REQ_EN BIT(0)
78 /* SPRD_DMA_CHN_PAUSE register definition */
79 #define SPRD_DMA_PAUSE_EN BIT(0)
80 #define SPRD_DMA_PAUSE_STS BIT(2)
81 #define SPRD_DMA_PAUSE_CNT 0x2000
83 /* DMA_CHN_WARP_* register definition */
84 #define SPRD_DMA_HIGH_ADDR_MASK GENMASK(31, 28)
85 #define SPRD_DMA_LOW_ADDR_MASK GENMASK(31, 0)
86 #define SPRD_DMA_HIGH_ADDR_OFFSET 4
88 /* SPRD_DMA_CHN_INTC register definition */
89 #define SPRD_DMA_FRAG_INT_STS BIT(16)
90 #define SPRD_DMA_BLK_INT_STS BIT(17)
91 #define SPRD_DMA_TRSC_INT_STS BIT(18)
92 #define SPRD_DMA_LIST_INT_STS BIT(19)
93 #define SPRD_DMA_CFGERR_INT_STS BIT(20)
94 #define SPRD_DMA_CHN_INT_STS \
95 (SPRD_DMA_FRAG_INT_STS | SPRD_DMA_BLK_INT_STS | \
96 SPRD_DMA_TRSC_INT_STS | SPRD_DMA_LIST_INT_STS | \
97 SPRD_DMA_CFGERR_INT_STS)
99 /* SPRD_DMA_CHN_FRG_LEN register definition */
100 #define SPRD_DMA_SRC_DATAWIDTH_OFFSET 30
101 #define SPRD_DMA_DES_DATAWIDTH_OFFSET 28
102 #define SPRD_DMA_SWT_MODE_OFFSET 26
103 #define SPRD_DMA_REQ_MODE_OFFSET 24
104 #define SPRD_DMA_REQ_MODE_MASK GENMASK(1, 0)
105 #define SPRD_DMA_FIX_SEL_OFFSET 21
106 #define SPRD_DMA_FIX_EN_OFFSET 20
107 #define SPRD_DMA_LLIST_END BIT(19)
108 #define SPRD_DMA_FRG_LEN_MASK GENMASK(16, 0)
110 /* SPRD_DMA_CHN_BLK_LEN register definition */
111 #define SPRD_DMA_BLK_LEN_MASK GENMASK(16, 0)
113 /* SPRD_DMA_CHN_TRSC_LEN register definition */
114 #define SPRD_DMA_TRSC_LEN_MASK GENMASK(27, 0)
116 /* SPRD_DMA_CHN_TRSF_STEP register definition */
117 #define SPRD_DMA_DEST_TRSF_STEP_OFFSET 16
118 #define SPRD_DMA_SRC_TRSF_STEP_OFFSET 0
119 #define SPRD_DMA_TRSF_STEP_MASK GENMASK(15, 0)
121 /* define the DMA transfer step type */
122 #define SPRD_DMA_NONE_STEP 0
123 #define SPRD_DMA_BYTE_STEP 1
124 #define SPRD_DMA_SHORT_STEP 2
125 #define SPRD_DMA_WORD_STEP 4
126 #define SPRD_DMA_DWORD_STEP 8
128 #define SPRD_DMA_SOFTWARE_UID 0
130 /* dma data width values */
131 enum sprd_dma_datawidth {
132 SPRD_DMA_DATAWIDTH_1_BYTE,
133 SPRD_DMA_DATAWIDTH_2_BYTES,
134 SPRD_DMA_DATAWIDTH_4_BYTES,
135 SPRD_DMA_DATAWIDTH_8_BYTES,
138 /* dma channel hardware configuration */
139 struct sprd_dma_chn_hw {
158 /* dma request description */
159 struct sprd_dma_desc {
160 struct virt_dma_desc vd;
161 struct sprd_dma_chn_hw chn_hw;
164 /* dma channel description */
165 struct sprd_dma_chn {
166 struct virt_dma_chan vc;
167 void __iomem *chn_base;
168 struct sprd_dma_linklist linklist;
169 struct dma_slave_config slave_cfg;
172 struct sprd_dma_desc *cur_desc;
175 /* SPRD dma device */
176 struct sprd_dma_dev {
177 struct dma_device dma_dev;
178 void __iomem *glb_base;
180 struct clk *ashb_clk;
183 struct sprd_dma_chn channels[0];
186 static bool sprd_dma_filter_fn(struct dma_chan *chan, void *param);
187 static struct of_dma_filter_info sprd_dma_info = {
188 .filter_fn = sprd_dma_filter_fn,
191 static inline struct sprd_dma_chn *to_sprd_dma_chan(struct dma_chan *c)
193 return container_of(c, struct sprd_dma_chn, vc.chan);
196 static inline struct sprd_dma_dev *to_sprd_dma_dev(struct dma_chan *c)
198 struct sprd_dma_chn *schan = to_sprd_dma_chan(c);
200 return container_of(schan, struct sprd_dma_dev, channels[c->chan_id]);
203 static inline struct sprd_dma_desc *to_sprd_dma_desc(struct virt_dma_desc *vd)
205 return container_of(vd, struct sprd_dma_desc, vd);
208 static void sprd_dma_chn_update(struct sprd_dma_chn *schan, u32 reg,
211 u32 orig = readl(schan->chn_base + reg);
214 tmp = (orig & ~mask) | val;
215 writel(tmp, schan->chn_base + reg);
218 static int sprd_dma_enable(struct sprd_dma_dev *sdev)
222 ret = clk_prepare_enable(sdev->clk);
227 * The ashb_clk is optional and only for AGCP DMA controller, so we
228 * need add one condition to check if the ashb_clk need enable.
230 if (!IS_ERR(sdev->ashb_clk))
231 ret = clk_prepare_enable(sdev->ashb_clk);
236 static void sprd_dma_disable(struct sprd_dma_dev *sdev)
238 clk_disable_unprepare(sdev->clk);
241 * Need to check if we need disable the optional ashb_clk for AGCP DMA.
243 if (!IS_ERR(sdev->ashb_clk))
244 clk_disable_unprepare(sdev->ashb_clk);
247 static void sprd_dma_set_uid(struct sprd_dma_chn *schan)
249 struct sprd_dma_dev *sdev = to_sprd_dma_dev(&schan->vc.chan);
250 u32 dev_id = schan->dev_id;
252 if (dev_id != SPRD_DMA_SOFTWARE_UID) {
253 u32 uid_offset = SPRD_DMA_GLB_REQ_UID_OFFSET +
254 SPRD_DMA_GLB_REQ_UID(dev_id);
256 writel(schan->chn_num + 1, sdev->glb_base + uid_offset);
260 static void sprd_dma_unset_uid(struct sprd_dma_chn *schan)
262 struct sprd_dma_dev *sdev = to_sprd_dma_dev(&schan->vc.chan);
263 u32 dev_id = schan->dev_id;
265 if (dev_id != SPRD_DMA_SOFTWARE_UID) {
266 u32 uid_offset = SPRD_DMA_GLB_REQ_UID_OFFSET +
267 SPRD_DMA_GLB_REQ_UID(dev_id);
269 writel(0, sdev->glb_base + uid_offset);
273 static void sprd_dma_clear_int(struct sprd_dma_chn *schan)
275 sprd_dma_chn_update(schan, SPRD_DMA_CHN_INTC,
276 SPRD_DMA_INT_MASK << SPRD_DMA_INT_CLR_OFFSET,
277 SPRD_DMA_INT_MASK << SPRD_DMA_INT_CLR_OFFSET);
280 static void sprd_dma_enable_chn(struct sprd_dma_chn *schan)
282 sprd_dma_chn_update(schan, SPRD_DMA_CHN_CFG, SPRD_DMA_CHN_EN,
286 static void sprd_dma_disable_chn(struct sprd_dma_chn *schan)
288 sprd_dma_chn_update(schan, SPRD_DMA_CHN_CFG, SPRD_DMA_CHN_EN, 0);
291 static void sprd_dma_soft_request(struct sprd_dma_chn *schan)
293 sprd_dma_chn_update(schan, SPRD_DMA_CHN_REQ, SPRD_DMA_REQ_EN,
297 static void sprd_dma_pause_resume(struct sprd_dma_chn *schan, bool enable)
299 struct sprd_dma_dev *sdev = to_sprd_dma_dev(&schan->vc.chan);
300 u32 pause, timeout = SPRD_DMA_PAUSE_CNT;
303 sprd_dma_chn_update(schan, SPRD_DMA_CHN_PAUSE,
304 SPRD_DMA_PAUSE_EN, SPRD_DMA_PAUSE_EN);
307 pause = readl(schan->chn_base + SPRD_DMA_CHN_PAUSE);
308 if (pause & SPRD_DMA_PAUSE_STS)
312 } while (--timeout > 0);
315 dev_warn(sdev->dma_dev.dev,
316 "pause dma controller timeout\n");
318 sprd_dma_chn_update(schan, SPRD_DMA_CHN_PAUSE,
319 SPRD_DMA_PAUSE_EN, 0);
323 static void sprd_dma_stop_and_disable(struct sprd_dma_chn *schan)
325 u32 cfg = readl(schan->chn_base + SPRD_DMA_CHN_CFG);
327 if (!(cfg & SPRD_DMA_CHN_EN))
330 sprd_dma_pause_resume(schan, true);
331 sprd_dma_disable_chn(schan);
334 static unsigned long sprd_dma_get_dst_addr(struct sprd_dma_chn *schan)
336 unsigned long addr, addr_high;
338 addr = readl(schan->chn_base + SPRD_DMA_CHN_DES_ADDR);
339 addr_high = readl(schan->chn_base + SPRD_DMA_CHN_WARP_TO) &
340 SPRD_DMA_HIGH_ADDR_MASK;
342 return addr | (addr_high << SPRD_DMA_HIGH_ADDR_OFFSET);
345 static enum sprd_dma_int_type sprd_dma_get_int_type(struct sprd_dma_chn *schan)
347 struct sprd_dma_dev *sdev = to_sprd_dma_dev(&schan->vc.chan);
348 u32 intc_sts = readl(schan->chn_base + SPRD_DMA_CHN_INTC) &
349 SPRD_DMA_CHN_INT_STS;
352 case SPRD_DMA_CFGERR_INT_STS:
353 return SPRD_DMA_CFGERR_INT;
355 case SPRD_DMA_LIST_INT_STS:
356 return SPRD_DMA_LIST_INT;
358 case SPRD_DMA_TRSC_INT_STS:
359 return SPRD_DMA_TRANS_INT;
361 case SPRD_DMA_BLK_INT_STS:
362 return SPRD_DMA_BLK_INT;
364 case SPRD_DMA_FRAG_INT_STS:
365 return SPRD_DMA_FRAG_INT;
368 dev_warn(sdev->dma_dev.dev, "incorrect dma interrupt type\n");
369 return SPRD_DMA_NO_INT;
373 static enum sprd_dma_req_mode sprd_dma_get_req_type(struct sprd_dma_chn *schan)
375 u32 frag_reg = readl(schan->chn_base + SPRD_DMA_CHN_FRG_LEN);
377 return (frag_reg >> SPRD_DMA_REQ_MODE_OFFSET) & SPRD_DMA_REQ_MODE_MASK;
380 static void sprd_dma_set_chn_config(struct sprd_dma_chn *schan,
381 struct sprd_dma_desc *sdesc)
383 struct sprd_dma_chn_hw *cfg = &sdesc->chn_hw;
385 writel(cfg->pause, schan->chn_base + SPRD_DMA_CHN_PAUSE);
386 writel(cfg->cfg, schan->chn_base + SPRD_DMA_CHN_CFG);
387 writel(cfg->intc, schan->chn_base + SPRD_DMA_CHN_INTC);
388 writel(cfg->src_addr, schan->chn_base + SPRD_DMA_CHN_SRC_ADDR);
389 writel(cfg->des_addr, schan->chn_base + SPRD_DMA_CHN_DES_ADDR);
390 writel(cfg->frg_len, schan->chn_base + SPRD_DMA_CHN_FRG_LEN);
391 writel(cfg->blk_len, schan->chn_base + SPRD_DMA_CHN_BLK_LEN);
392 writel(cfg->trsc_len, schan->chn_base + SPRD_DMA_CHN_TRSC_LEN);
393 writel(cfg->trsf_step, schan->chn_base + SPRD_DMA_CHN_TRSF_STEP);
394 writel(cfg->wrap_ptr, schan->chn_base + SPRD_DMA_CHN_WARP_PTR);
395 writel(cfg->wrap_to, schan->chn_base + SPRD_DMA_CHN_WARP_TO);
396 writel(cfg->llist_ptr, schan->chn_base + SPRD_DMA_CHN_LLIST_PTR);
397 writel(cfg->frg_step, schan->chn_base + SPRD_DMA_CHN_FRAG_STEP);
398 writel(cfg->src_blk_step, schan->chn_base + SPRD_DMA_CHN_SRC_BLK_STEP);
399 writel(cfg->des_blk_step, schan->chn_base + SPRD_DMA_CHN_DES_BLK_STEP);
400 writel(cfg->req, schan->chn_base + SPRD_DMA_CHN_REQ);
403 static void sprd_dma_start(struct sprd_dma_chn *schan)
405 struct virt_dma_desc *vd = vchan_next_desc(&schan->vc);
411 schan->cur_desc = to_sprd_dma_desc(vd);
414 * Copy the DMA configuration from DMA descriptor to this hardware
417 sprd_dma_set_chn_config(schan, schan->cur_desc);
418 sprd_dma_set_uid(schan);
419 sprd_dma_enable_chn(schan);
421 if (schan->dev_id == SPRD_DMA_SOFTWARE_UID)
422 sprd_dma_soft_request(schan);
425 static void sprd_dma_stop(struct sprd_dma_chn *schan)
427 sprd_dma_stop_and_disable(schan);
428 sprd_dma_unset_uid(schan);
429 sprd_dma_clear_int(schan);
432 static bool sprd_dma_check_trans_done(struct sprd_dma_desc *sdesc,
433 enum sprd_dma_int_type int_type,
434 enum sprd_dma_req_mode req_mode)
436 if (int_type == SPRD_DMA_NO_INT)
439 if (int_type >= req_mode + 1)
445 static irqreturn_t dma_irq_handle(int irq, void *dev_id)
447 struct sprd_dma_dev *sdev = (struct sprd_dma_dev *)dev_id;
448 u32 irq_status = readl(sdev->glb_base + SPRD_DMA_GLB_INT_MSK_STS);
449 struct sprd_dma_chn *schan;
450 struct sprd_dma_desc *sdesc;
451 enum sprd_dma_req_mode req_type;
452 enum sprd_dma_int_type int_type;
453 bool trans_done = false;
457 i = __ffs(irq_status);
458 irq_status &= (irq_status - 1);
459 schan = &sdev->channels[i];
461 spin_lock(&schan->vc.lock);
462 int_type = sprd_dma_get_int_type(schan);
463 req_type = sprd_dma_get_req_type(schan);
464 sprd_dma_clear_int(schan);
466 sdesc = schan->cur_desc;
468 /* Check if the dma request descriptor is done. */
469 trans_done = sprd_dma_check_trans_done(sdesc, int_type,
471 if (trans_done == true) {
472 vchan_cookie_complete(&sdesc->vd);
473 schan->cur_desc = NULL;
474 sprd_dma_start(schan);
476 spin_unlock(&schan->vc.lock);
482 static int sprd_dma_alloc_chan_resources(struct dma_chan *chan)
484 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
487 ret = pm_runtime_get_sync(chan->device->dev);
491 schan->dev_id = SPRD_DMA_SOFTWARE_UID;
495 static void sprd_dma_free_chan_resources(struct dma_chan *chan)
497 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
500 spin_lock_irqsave(&schan->vc.lock, flags);
501 sprd_dma_stop(schan);
502 spin_unlock_irqrestore(&schan->vc.lock, flags);
504 vchan_free_chan_resources(&schan->vc);
505 pm_runtime_put(chan->device->dev);
508 static enum dma_status sprd_dma_tx_status(struct dma_chan *chan,
510 struct dma_tx_state *txstate)
512 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
513 struct virt_dma_desc *vd;
518 ret = dma_cookie_status(chan, cookie, txstate);
519 if (ret == DMA_COMPLETE || !txstate)
522 spin_lock_irqsave(&schan->vc.lock, flags);
523 vd = vchan_find_desc(&schan->vc, cookie);
525 struct sprd_dma_desc *sdesc = to_sprd_dma_desc(vd);
526 struct sprd_dma_chn_hw *hw = &sdesc->chn_hw;
528 if (hw->trsc_len > 0)
530 else if (hw->blk_len > 0)
532 else if (hw->frg_len > 0)
536 } else if (schan->cur_desc && schan->cur_desc->vd.tx.cookie == cookie) {
537 pos = sprd_dma_get_dst_addr(schan);
541 spin_unlock_irqrestore(&schan->vc.lock, flags);
543 dma_set_residue(txstate, pos);
547 static void sprd_dma_issue_pending(struct dma_chan *chan)
549 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
552 spin_lock_irqsave(&schan->vc.lock, flags);
553 if (vchan_issue_pending(&schan->vc) && !schan->cur_desc)
554 sprd_dma_start(schan);
555 spin_unlock_irqrestore(&schan->vc.lock, flags);
558 static int sprd_dma_get_datawidth(enum dma_slave_buswidth buswidth)
561 case DMA_SLAVE_BUSWIDTH_1_BYTE:
562 case DMA_SLAVE_BUSWIDTH_2_BYTES:
563 case DMA_SLAVE_BUSWIDTH_4_BYTES:
564 case DMA_SLAVE_BUSWIDTH_8_BYTES:
565 return ffs(buswidth) - 1;
572 static int sprd_dma_get_step(enum dma_slave_buswidth buswidth)
575 case DMA_SLAVE_BUSWIDTH_1_BYTE:
576 case DMA_SLAVE_BUSWIDTH_2_BYTES:
577 case DMA_SLAVE_BUSWIDTH_4_BYTES:
578 case DMA_SLAVE_BUSWIDTH_8_BYTES:
586 static int sprd_dma_fill_desc(struct dma_chan *chan,
587 struct sprd_dma_chn_hw *hw,
588 unsigned int sglen, int sg_index,
589 dma_addr_t src, dma_addr_t dst, u32 len,
590 enum dma_transfer_direction dir,
592 struct dma_slave_config *slave_cfg)
594 struct sprd_dma_dev *sdev = to_sprd_dma_dev(chan);
595 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
596 u32 req_mode = (flags >> SPRD_DMA_REQ_SHIFT) & SPRD_DMA_REQ_MODE_MASK;
597 u32 int_mode = flags & SPRD_DMA_INT_MASK;
598 int src_datawidth, dst_datawidth, src_step, dst_step;
599 u32 temp, fix_mode = 0, fix_en = 0;
601 if (dir == DMA_MEM_TO_DEV) {
602 src_step = sprd_dma_get_step(slave_cfg->src_addr_width);
604 dev_err(sdev->dma_dev.dev, "invalid source step\n");
607 dst_step = SPRD_DMA_NONE_STEP;
609 dst_step = sprd_dma_get_step(slave_cfg->dst_addr_width);
611 dev_err(sdev->dma_dev.dev, "invalid destination step\n");
614 src_step = SPRD_DMA_NONE_STEP;
617 src_datawidth = sprd_dma_get_datawidth(slave_cfg->src_addr_width);
618 if (src_datawidth < 0) {
619 dev_err(sdev->dma_dev.dev, "invalid source datawidth\n");
620 return src_datawidth;
623 dst_datawidth = sprd_dma_get_datawidth(slave_cfg->dst_addr_width);
624 if (dst_datawidth < 0) {
625 dev_err(sdev->dma_dev.dev, "invalid destination datawidth\n");
626 return dst_datawidth;
629 if (slave_cfg->slave_id)
630 schan->dev_id = slave_cfg->slave_id;
632 hw->cfg = SPRD_DMA_DONOT_WAIT_BDONE << SPRD_DMA_WAIT_BDONE_OFFSET;
635 * wrap_ptr and wrap_to will save the high 4 bits source address and
636 * destination address.
638 hw->wrap_ptr = (src >> SPRD_DMA_HIGH_ADDR_OFFSET) & SPRD_DMA_HIGH_ADDR_MASK;
639 hw->wrap_to = (dst >> SPRD_DMA_HIGH_ADDR_OFFSET) & SPRD_DMA_HIGH_ADDR_MASK;
640 hw->src_addr = src & SPRD_DMA_LOW_ADDR_MASK;
641 hw->des_addr = dst & SPRD_DMA_LOW_ADDR_MASK;
644 * If the src step and dst step both are 0 or both are not 0, that means
645 * we can not enable the fix mode. If one is 0 and another one is not,
646 * we can enable the fix mode.
648 if ((src_step != 0 && dst_step != 0) || (src_step | dst_step) == 0) {
658 hw->intc = int_mode | SPRD_DMA_CFG_ERR_INT_EN;
660 temp = src_datawidth << SPRD_DMA_SRC_DATAWIDTH_OFFSET;
661 temp |= dst_datawidth << SPRD_DMA_DES_DATAWIDTH_OFFSET;
662 temp |= req_mode << SPRD_DMA_REQ_MODE_OFFSET;
663 temp |= fix_mode << SPRD_DMA_FIX_SEL_OFFSET;
664 temp |= fix_en << SPRD_DMA_FIX_EN_OFFSET;
665 temp |= slave_cfg->src_maxburst & SPRD_DMA_FRG_LEN_MASK;
668 hw->blk_len = len & SPRD_DMA_BLK_LEN_MASK;
669 hw->trsc_len = len & SPRD_DMA_TRSC_LEN_MASK;
671 temp = (dst_step & SPRD_DMA_TRSF_STEP_MASK) << SPRD_DMA_DEST_TRSF_STEP_OFFSET;
672 temp |= (src_step & SPRD_DMA_TRSF_STEP_MASK) << SPRD_DMA_SRC_TRSF_STEP_OFFSET;
673 hw->trsf_step = temp;
675 /* link-list configuration */
676 if (schan->linklist.phy_addr) {
677 if (sg_index == sglen - 1)
678 hw->frg_len |= SPRD_DMA_LLIST_END;
680 hw->cfg |= SPRD_DMA_LINKLIST_EN;
682 /* link-list index */
683 temp = (sg_index + 1) % sglen;
684 /* Next link-list configuration's physical address offset */
685 temp = temp * sizeof(*hw) + SPRD_DMA_CHN_SRC_ADDR;
687 * Set the link-list pointer point to next link-list
688 * configuration's physical address.
690 hw->llist_ptr = schan->linklist.phy_addr + temp;
696 hw->src_blk_step = 0;
697 hw->des_blk_step = 0;
701 static int sprd_dma_fill_linklist_desc(struct dma_chan *chan,
702 unsigned int sglen, int sg_index,
703 dma_addr_t src, dma_addr_t dst, u32 len,
704 enum dma_transfer_direction dir,
706 struct dma_slave_config *slave_cfg)
708 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
709 struct sprd_dma_chn_hw *hw;
711 if (!schan->linklist.virt_addr)
714 hw = (struct sprd_dma_chn_hw *)(schan->linklist.virt_addr +
715 sg_index * sizeof(*hw));
717 return sprd_dma_fill_desc(chan, hw, sglen, sg_index, src, dst, len,
718 dir, flags, slave_cfg);
721 static struct dma_async_tx_descriptor *
722 sprd_dma_prep_dma_memcpy(struct dma_chan *chan, dma_addr_t dest, dma_addr_t src,
723 size_t len, unsigned long flags)
725 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
726 struct sprd_dma_desc *sdesc;
727 struct sprd_dma_chn_hw *hw;
728 enum sprd_dma_datawidth datawidth;
731 sdesc = kzalloc(sizeof(*sdesc), GFP_NOWAIT);
737 hw->cfg = SPRD_DMA_DONOT_WAIT_BDONE << SPRD_DMA_WAIT_BDONE_OFFSET;
738 hw->intc = SPRD_DMA_TRANS_INT | SPRD_DMA_CFG_ERR_INT_EN;
739 hw->src_addr = src & SPRD_DMA_LOW_ADDR_MASK;
740 hw->des_addr = dest & SPRD_DMA_LOW_ADDR_MASK;
741 hw->wrap_ptr = (src >> SPRD_DMA_HIGH_ADDR_OFFSET) &
742 SPRD_DMA_HIGH_ADDR_MASK;
743 hw->wrap_to = (dest >> SPRD_DMA_HIGH_ADDR_OFFSET) &
744 SPRD_DMA_HIGH_ADDR_MASK;
746 if (IS_ALIGNED(len, 8)) {
747 datawidth = SPRD_DMA_DATAWIDTH_8_BYTES;
748 step = SPRD_DMA_DWORD_STEP;
749 } else if (IS_ALIGNED(len, 4)) {
750 datawidth = SPRD_DMA_DATAWIDTH_4_BYTES;
751 step = SPRD_DMA_WORD_STEP;
752 } else if (IS_ALIGNED(len, 2)) {
753 datawidth = SPRD_DMA_DATAWIDTH_2_BYTES;
754 step = SPRD_DMA_SHORT_STEP;
756 datawidth = SPRD_DMA_DATAWIDTH_1_BYTE;
757 step = SPRD_DMA_BYTE_STEP;
760 temp = datawidth << SPRD_DMA_SRC_DATAWIDTH_OFFSET;
761 temp |= datawidth << SPRD_DMA_DES_DATAWIDTH_OFFSET;
762 temp |= SPRD_DMA_TRANS_REQ << SPRD_DMA_REQ_MODE_OFFSET;
763 temp |= len & SPRD_DMA_FRG_LEN_MASK;
766 hw->blk_len = len & SPRD_DMA_BLK_LEN_MASK;
767 hw->trsc_len = len & SPRD_DMA_TRSC_LEN_MASK;
769 temp = (step & SPRD_DMA_TRSF_STEP_MASK) << SPRD_DMA_DEST_TRSF_STEP_OFFSET;
770 temp |= (step & SPRD_DMA_TRSF_STEP_MASK) << SPRD_DMA_SRC_TRSF_STEP_OFFSET;
771 hw->trsf_step = temp;
773 return vchan_tx_prep(&schan->vc, &sdesc->vd, flags);
776 static struct dma_async_tx_descriptor *
777 sprd_dma_prep_slave_sg(struct dma_chan *chan, struct scatterlist *sgl,
778 unsigned int sglen, enum dma_transfer_direction dir,
779 unsigned long flags, void *context)
781 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
782 struct dma_slave_config *slave_cfg = &schan->slave_cfg;
783 dma_addr_t src = 0, dst = 0;
784 struct sprd_dma_desc *sdesc;
785 struct scatterlist *sg;
789 if (!is_slave_direction(dir))
793 struct sprd_dma_linklist *ll_cfg =
794 (struct sprd_dma_linklist *)context;
796 schan->linklist.phy_addr = ll_cfg->phy_addr;
797 schan->linklist.virt_addr = ll_cfg->virt_addr;
799 schan->linklist.phy_addr = 0;
800 schan->linklist.virt_addr = 0;
803 sdesc = kzalloc(sizeof(*sdesc), GFP_NOWAIT);
807 for_each_sg(sgl, sg, sglen, i) {
808 len = sg_dma_len(sg);
810 if (dir == DMA_MEM_TO_DEV) {
811 src = sg_dma_address(sg);
812 dst = slave_cfg->dst_addr;
814 src = slave_cfg->src_addr;
815 dst = sg_dma_address(sg);
819 * The link-list mode needs at least 2 link-list
820 * configurations. If there is only one sg, it doesn't
821 * need to fill the link-list configuration.
826 ret = sprd_dma_fill_linklist_desc(chan, sglen, i, src, dst, len,
827 dir, flags, slave_cfg);
834 ret = sprd_dma_fill_desc(chan, &sdesc->chn_hw, 0, 0, src, dst, len,
835 dir, flags, slave_cfg);
841 return vchan_tx_prep(&schan->vc, &sdesc->vd, flags);
844 static int sprd_dma_slave_config(struct dma_chan *chan,
845 struct dma_slave_config *config)
847 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
848 struct dma_slave_config *slave_cfg = &schan->slave_cfg;
850 if (!is_slave_direction(config->direction))
853 memcpy(slave_cfg, config, sizeof(*config));
857 static int sprd_dma_pause(struct dma_chan *chan)
859 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
862 spin_lock_irqsave(&schan->vc.lock, flags);
863 sprd_dma_pause_resume(schan, true);
864 spin_unlock_irqrestore(&schan->vc.lock, flags);
869 static int sprd_dma_resume(struct dma_chan *chan)
871 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
874 spin_lock_irqsave(&schan->vc.lock, flags);
875 sprd_dma_pause_resume(schan, false);
876 spin_unlock_irqrestore(&schan->vc.lock, flags);
881 static int sprd_dma_terminate_all(struct dma_chan *chan)
883 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
887 spin_lock_irqsave(&schan->vc.lock, flags);
888 sprd_dma_stop(schan);
890 vchan_get_all_descriptors(&schan->vc, &head);
891 spin_unlock_irqrestore(&schan->vc.lock, flags);
893 vchan_dma_desc_free_list(&schan->vc, &head);
897 static void sprd_dma_free_desc(struct virt_dma_desc *vd)
899 struct sprd_dma_desc *sdesc = to_sprd_dma_desc(vd);
904 static bool sprd_dma_filter_fn(struct dma_chan *chan, void *param)
906 struct sprd_dma_chn *schan = to_sprd_dma_chan(chan);
907 struct sprd_dma_dev *sdev = to_sprd_dma_dev(&schan->vc.chan);
908 u32 req = *(u32 *)param;
910 if (req < sdev->total_chns)
911 return req == schan->chn_num + 1;
916 static int sprd_dma_probe(struct platform_device *pdev)
918 struct device_node *np = pdev->dev.of_node;
919 struct sprd_dma_dev *sdev;
920 struct sprd_dma_chn *dma_chn;
921 struct resource *res;
925 ret = device_property_read_u32(&pdev->dev, "#dma-channels", &chn_count);
927 dev_err(&pdev->dev, "get dma channels count failed\n");
931 sdev = devm_kzalloc(&pdev->dev,
932 struct_size(sdev, channels, chn_count),
937 sdev->clk = devm_clk_get(&pdev->dev, "enable");
938 if (IS_ERR(sdev->clk)) {
939 dev_err(&pdev->dev, "get enable clock failed\n");
940 return PTR_ERR(sdev->clk);
943 /* ashb clock is optional for AGCP DMA */
944 sdev->ashb_clk = devm_clk_get(&pdev->dev, "ashb_eb");
945 if (IS_ERR(sdev->ashb_clk))
946 dev_warn(&pdev->dev, "no optional ashb eb clock\n");
949 * We have three DMA controllers: AP DMA, AON DMA and AGCP DMA. For AGCP
950 * DMA controller, it can or do not request the irq, which will save
951 * system power without resuming system by DMA interrupts if AGCP DMA
952 * does not request the irq. Thus the DMA interrupts property should
955 sdev->irq = platform_get_irq(pdev, 0);
957 ret = devm_request_irq(&pdev->dev, sdev->irq, dma_irq_handle,
958 0, "sprd_dma", (void *)sdev);
960 dev_err(&pdev->dev, "request dma irq failed\n");
964 dev_warn(&pdev->dev, "no interrupts for the dma controller\n");
967 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
968 sdev->glb_base = devm_ioremap_resource(&pdev->dev, res);
969 if (IS_ERR(sdev->glb_base))
970 return PTR_ERR(sdev->glb_base);
972 dma_cap_set(DMA_MEMCPY, sdev->dma_dev.cap_mask);
973 sdev->total_chns = chn_count;
974 sdev->dma_dev.chancnt = chn_count;
975 INIT_LIST_HEAD(&sdev->dma_dev.channels);
976 INIT_LIST_HEAD(&sdev->dma_dev.global_node);
977 sdev->dma_dev.dev = &pdev->dev;
978 sdev->dma_dev.device_alloc_chan_resources = sprd_dma_alloc_chan_resources;
979 sdev->dma_dev.device_free_chan_resources = sprd_dma_free_chan_resources;
980 sdev->dma_dev.device_tx_status = sprd_dma_tx_status;
981 sdev->dma_dev.device_issue_pending = sprd_dma_issue_pending;
982 sdev->dma_dev.device_prep_dma_memcpy = sprd_dma_prep_dma_memcpy;
983 sdev->dma_dev.device_prep_slave_sg = sprd_dma_prep_slave_sg;
984 sdev->dma_dev.device_config = sprd_dma_slave_config;
985 sdev->dma_dev.device_pause = sprd_dma_pause;
986 sdev->dma_dev.device_resume = sprd_dma_resume;
987 sdev->dma_dev.device_terminate_all = sprd_dma_terminate_all;
989 for (i = 0; i < chn_count; i++) {
990 dma_chn = &sdev->channels[i];
991 dma_chn->chn_num = i;
992 dma_chn->cur_desc = NULL;
993 /* get each channel's registers base address. */
994 dma_chn->chn_base = sdev->glb_base + SPRD_DMA_CHN_REG_OFFSET +
995 SPRD_DMA_CHN_REG_LENGTH * i;
997 dma_chn->vc.desc_free = sprd_dma_free_desc;
998 vchan_init(&dma_chn->vc, &sdev->dma_dev);
1001 platform_set_drvdata(pdev, sdev);
1002 ret = sprd_dma_enable(sdev);
1006 pm_runtime_set_active(&pdev->dev);
1007 pm_runtime_enable(&pdev->dev);
1009 ret = pm_runtime_get_sync(&pdev->dev);
1013 ret = dma_async_device_register(&sdev->dma_dev);
1015 dev_err(&pdev->dev, "register dma device failed:%d\n", ret);
1019 sprd_dma_info.dma_cap = sdev->dma_dev.cap_mask;
1020 ret = of_dma_controller_register(np, of_dma_simple_xlate,
1023 goto err_of_register;
1025 pm_runtime_put(&pdev->dev);
1029 dma_async_device_unregister(&sdev->dma_dev);
1031 pm_runtime_put_noidle(&pdev->dev);
1032 pm_runtime_disable(&pdev->dev);
1034 sprd_dma_disable(sdev);
1038 static int sprd_dma_remove(struct platform_device *pdev)
1040 struct sprd_dma_dev *sdev = platform_get_drvdata(pdev);
1041 struct sprd_dma_chn *c, *cn;
1044 ret = pm_runtime_get_sync(&pdev->dev);
1048 /* explicitly free the irq */
1050 devm_free_irq(&pdev->dev, sdev->irq, sdev);
1052 list_for_each_entry_safe(c, cn, &sdev->dma_dev.channels,
1053 vc.chan.device_node) {
1054 list_del(&c->vc.chan.device_node);
1055 tasklet_kill(&c->vc.task);
1058 of_dma_controller_free(pdev->dev.of_node);
1059 dma_async_device_unregister(&sdev->dma_dev);
1060 sprd_dma_disable(sdev);
1062 pm_runtime_put_noidle(&pdev->dev);
1063 pm_runtime_disable(&pdev->dev);
1067 static const struct of_device_id sprd_dma_match[] = {
1068 { .compatible = "sprd,sc9860-dma", },
1072 static int __maybe_unused sprd_dma_runtime_suspend(struct device *dev)
1074 struct sprd_dma_dev *sdev = dev_get_drvdata(dev);
1076 sprd_dma_disable(sdev);
1080 static int __maybe_unused sprd_dma_runtime_resume(struct device *dev)
1082 struct sprd_dma_dev *sdev = dev_get_drvdata(dev);
1085 ret = sprd_dma_enable(sdev);
1087 dev_err(sdev->dma_dev.dev, "enable dma failed\n");
1092 static const struct dev_pm_ops sprd_dma_pm_ops = {
1093 SET_RUNTIME_PM_OPS(sprd_dma_runtime_suspend,
1094 sprd_dma_runtime_resume,
1098 static struct platform_driver sprd_dma_driver = {
1099 .probe = sprd_dma_probe,
1100 .remove = sprd_dma_remove,
1103 .of_match_table = sprd_dma_match,
1104 .pm = &sprd_dma_pm_ops,
1107 module_platform_driver(sprd_dma_driver);
1109 MODULE_LICENSE("GPL v2");
1110 MODULE_DESCRIPTION("DMA driver for Spreadtrum");
1111 MODULE_AUTHOR("Baolin Wang <baolin.wang@spreadtrum.com>");
1112 MODULE_ALIAS("platform:sprd-dma");