2 * OMAP DMAengine support
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
8 #include <linux/delay.h>
9 #include <linux/dmaengine.h>
10 #include <linux/dma-mapping.h>
11 #include <linux/err.h>
12 #include <linux/init.h>
13 #include <linux/interrupt.h>
14 #include <linux/list.h>
15 #include <linux/module.h>
16 #include <linux/omap-dma.h>
17 #include <linux/platform_device.h>
18 #include <linux/slab.h>
19 #include <linux/spinlock.h>
20 #include <linux/of_dma.h>
21 #include <linux/of_device.h>
25 #define OMAP_SDMA_REQUESTS 127
26 #define OMAP_SDMA_CHANNELS 32
29 struct dma_device ddev
;
31 struct tasklet_struct task
;
32 struct list_head pending
;
34 const struct omap_dma_reg
*reg_map
;
35 struct omap_system_dma_plat_info
*plat
;
37 unsigned dma_requests
;
39 uint32_t irq_enable_mask
;
40 struct omap_chan
*lch_map
[OMAP_SDMA_CHANNELS
];
44 struct virt_dma_chan vc
;
45 struct list_head node
;
46 void __iomem
*channel_base
;
47 const struct omap_dma_reg
*reg_map
;
50 struct dma_slave_config cfg
;
56 struct omap_desc
*desc
;
62 uint32_t en
; /* number of elements (24-bit) */
63 uint32_t fn
; /* number of frames (16-bit) */
67 struct virt_dma_desc vd
;
68 enum dma_transfer_direction dir
;
71 int16_t fi
; /* for OMAP_DMA_SYNC_PACKET */
72 uint8_t es
; /* CSDP_DATA_TYPE_xxx */
73 uint32_t ccr
; /* CCR value */
74 uint16_t clnk_ctrl
; /* CLNK_CTRL value */
75 uint16_t cicr
; /* CICR value */
76 uint32_t csdp
; /* CSDP value */
84 CCR_READ_PRIORITY
= BIT(6),
86 CCR_AUTO_INIT
= BIT(8), /* OMAP1 only */
87 CCR_REPEAT
= BIT(9), /* OMAP1 only */
88 CCR_OMAP31_DISABLE
= BIT(10), /* OMAP1 only */
89 CCR_SUSPEND_SENSITIVE
= BIT(8), /* OMAP2+ only */
90 CCR_RD_ACTIVE
= BIT(9), /* OMAP2+ only */
91 CCR_WR_ACTIVE
= BIT(10), /* OMAP2+ only */
92 CCR_SRC_AMODE_CONSTANT
= 0 << 12,
93 CCR_SRC_AMODE_POSTINC
= 1 << 12,
94 CCR_SRC_AMODE_SGLIDX
= 2 << 12,
95 CCR_SRC_AMODE_DBLIDX
= 3 << 12,
96 CCR_DST_AMODE_CONSTANT
= 0 << 14,
97 CCR_DST_AMODE_POSTINC
= 1 << 14,
98 CCR_DST_AMODE_SGLIDX
= 2 << 14,
99 CCR_DST_AMODE_DBLIDX
= 3 << 14,
100 CCR_CONSTANT_FILL
= BIT(16),
101 CCR_TRANSPARENT_COPY
= BIT(17),
103 CCR_SUPERVISOR
= BIT(22),
104 CCR_PREFETCH
= BIT(23),
105 CCR_TRIGGER_SRC
= BIT(24),
106 CCR_BUFFERING_DISABLE
= BIT(25),
107 CCR_WRITE_PRIORITY
= BIT(26),
108 CCR_SYNC_ELEMENT
= 0,
109 CCR_SYNC_FRAME
= CCR_FS
,
110 CCR_SYNC_BLOCK
= CCR_BS
,
111 CCR_SYNC_PACKET
= CCR_BS
| CCR_FS
,
113 CSDP_DATA_TYPE_8
= 0,
114 CSDP_DATA_TYPE_16
= 1,
115 CSDP_DATA_TYPE_32
= 2,
116 CSDP_SRC_PORT_EMIFF
= 0 << 2, /* OMAP1 only */
117 CSDP_SRC_PORT_EMIFS
= 1 << 2, /* OMAP1 only */
118 CSDP_SRC_PORT_OCP_T1
= 2 << 2, /* OMAP1 only */
119 CSDP_SRC_PORT_TIPB
= 3 << 2, /* OMAP1 only */
120 CSDP_SRC_PORT_OCP_T2
= 4 << 2, /* OMAP1 only */
121 CSDP_SRC_PORT_MPUI
= 5 << 2, /* OMAP1 only */
122 CSDP_SRC_PACKED
= BIT(6),
123 CSDP_SRC_BURST_1
= 0 << 7,
124 CSDP_SRC_BURST_16
= 1 << 7,
125 CSDP_SRC_BURST_32
= 2 << 7,
126 CSDP_SRC_BURST_64
= 3 << 7,
127 CSDP_DST_PORT_EMIFF
= 0 << 9, /* OMAP1 only */
128 CSDP_DST_PORT_EMIFS
= 1 << 9, /* OMAP1 only */
129 CSDP_DST_PORT_OCP_T1
= 2 << 9, /* OMAP1 only */
130 CSDP_DST_PORT_TIPB
= 3 << 9, /* OMAP1 only */
131 CSDP_DST_PORT_OCP_T2
= 4 << 9, /* OMAP1 only */
132 CSDP_DST_PORT_MPUI
= 5 << 9, /* OMAP1 only */
133 CSDP_DST_PACKED
= BIT(13),
134 CSDP_DST_BURST_1
= 0 << 14,
135 CSDP_DST_BURST_16
= 1 << 14,
136 CSDP_DST_BURST_32
= 2 << 14,
137 CSDP_DST_BURST_64
= 3 << 14,
139 CICR_TOUT_IE
= BIT(0), /* OMAP1 only */
140 CICR_DROP_IE
= BIT(1),
141 CICR_HALF_IE
= BIT(2),
142 CICR_FRAME_IE
= BIT(3),
143 CICR_LAST_IE
= BIT(4),
144 CICR_BLOCK_IE
= BIT(5),
145 CICR_PKT_IE
= BIT(7), /* OMAP2+ only */
146 CICR_TRANS_ERR_IE
= BIT(8), /* OMAP2+ only */
147 CICR_SUPERVISOR_ERR_IE
= BIT(10), /* OMAP2+ only */
148 CICR_MISALIGNED_ERR_IE
= BIT(11), /* OMAP2+ only */
149 CICR_DRAIN_IE
= BIT(12), /* OMAP2+ only */
150 CICR_SUPER_BLOCK_IE
= BIT(14), /* OMAP2+ only */
152 CLNK_CTRL_ENABLE_LNK
= BIT(15),
155 static const unsigned es_bytes
[] = {
156 [CSDP_DATA_TYPE_8
] = 1,
157 [CSDP_DATA_TYPE_16
] = 2,
158 [CSDP_DATA_TYPE_32
] = 4,
161 static struct of_dma_filter_info omap_dma_info
= {
162 .filter_fn
= omap_dma_filter_fn
,
165 static inline struct omap_dmadev
*to_omap_dma_dev(struct dma_device
*d
)
167 return container_of(d
, struct omap_dmadev
, ddev
);
170 static inline struct omap_chan
*to_omap_dma_chan(struct dma_chan
*c
)
172 return container_of(c
, struct omap_chan
, vc
.chan
);
175 static inline struct omap_desc
*to_omap_dma_desc(struct dma_async_tx_descriptor
*t
)
177 return container_of(t
, struct omap_desc
, vd
.tx
);
180 static void omap_dma_desc_free(struct virt_dma_desc
*vd
)
182 kfree(container_of(vd
, struct omap_desc
, vd
));
185 static void omap_dma_write(uint32_t val
, unsigned type
, void __iomem
*addr
)
188 case OMAP_DMA_REG_16BIT
:
189 writew_relaxed(val
, addr
);
191 case OMAP_DMA_REG_2X16BIT
:
192 writew_relaxed(val
, addr
);
193 writew_relaxed(val
>> 16, addr
+ 2);
195 case OMAP_DMA_REG_32BIT
:
196 writel_relaxed(val
, addr
);
203 static unsigned omap_dma_read(unsigned type
, void __iomem
*addr
)
208 case OMAP_DMA_REG_16BIT
:
209 val
= readw_relaxed(addr
);
211 case OMAP_DMA_REG_2X16BIT
:
212 val
= readw_relaxed(addr
);
213 val
|= readw_relaxed(addr
+ 2) << 16;
215 case OMAP_DMA_REG_32BIT
:
216 val
= readl_relaxed(addr
);
226 static void omap_dma_glbl_write(struct omap_dmadev
*od
, unsigned reg
, unsigned val
)
228 const struct omap_dma_reg
*r
= od
->reg_map
+ reg
;
232 omap_dma_write(val
, r
->type
, od
->base
+ r
->offset
);
235 static unsigned omap_dma_glbl_read(struct omap_dmadev
*od
, unsigned reg
)
237 const struct omap_dma_reg
*r
= od
->reg_map
+ reg
;
241 return omap_dma_read(r
->type
, od
->base
+ r
->offset
);
244 static void omap_dma_chan_write(struct omap_chan
*c
, unsigned reg
, unsigned val
)
246 const struct omap_dma_reg
*r
= c
->reg_map
+ reg
;
248 omap_dma_write(val
, r
->type
, c
->channel_base
+ r
->offset
);
251 static unsigned omap_dma_chan_read(struct omap_chan
*c
, unsigned reg
)
253 const struct omap_dma_reg
*r
= c
->reg_map
+ reg
;
255 return omap_dma_read(r
->type
, c
->channel_base
+ r
->offset
);
258 static void omap_dma_clear_csr(struct omap_chan
*c
)
261 omap_dma_chan_read(c
, CSR
);
263 omap_dma_chan_write(c
, CSR
, ~0);
266 static unsigned omap_dma_get_csr(struct omap_chan
*c
)
268 unsigned val
= omap_dma_chan_read(c
, CSR
);
271 omap_dma_chan_write(c
, CSR
, val
);
276 static void omap_dma_assign(struct omap_dmadev
*od
, struct omap_chan
*c
,
279 c
->channel_base
= od
->base
+ od
->plat
->channel_stride
* lch
;
281 od
->lch_map
[lch
] = c
;
284 static void omap_dma_start(struct omap_chan
*c
, struct omap_desc
*d
)
286 struct omap_dmadev
*od
= to_omap_dma_dev(c
->vc
.chan
.device
);
288 if (__dma_omap15xx(od
->plat
->dma_attr
))
289 omap_dma_chan_write(c
, CPC
, 0);
291 omap_dma_chan_write(c
, CDAC
, 0);
293 omap_dma_clear_csr(c
);
295 /* Enable interrupts */
296 omap_dma_chan_write(c
, CICR
, d
->cicr
);
299 omap_dma_chan_write(c
, CCR
, d
->ccr
| CCR_ENABLE
);
302 static void omap_dma_stop(struct omap_chan
*c
)
304 struct omap_dmadev
*od
= to_omap_dma_dev(c
->vc
.chan
.device
);
308 omap_dma_chan_write(c
, CICR
, 0);
310 omap_dma_clear_csr(c
);
312 val
= omap_dma_chan_read(c
, CCR
);
313 if (od
->plat
->errata
& DMA_ERRATA_i541
&& val
& CCR_TRIGGER_SRC
) {
317 sysconfig
= omap_dma_glbl_read(od
, OCP_SYSCONFIG
);
318 val
= sysconfig
& ~DMA_SYSCONFIG_MIDLEMODE_MASK
;
319 val
|= DMA_SYSCONFIG_MIDLEMODE(DMA_IDLEMODE_NO_IDLE
);
320 omap_dma_glbl_write(od
, OCP_SYSCONFIG
, val
);
322 val
= omap_dma_chan_read(c
, CCR
);
324 omap_dma_chan_write(c
, CCR
, val
);
326 /* Wait for sDMA FIFO to drain */
328 val
= omap_dma_chan_read(c
, CCR
);
329 if (!(val
& (CCR_RD_ACTIVE
| CCR_WR_ACTIVE
)))
338 if (val
& (CCR_RD_ACTIVE
| CCR_WR_ACTIVE
))
339 dev_err(c
->vc
.chan
.device
->dev
,
340 "DMA drain did not complete on lch %d\n",
343 omap_dma_glbl_write(od
, OCP_SYSCONFIG
, sysconfig
);
346 omap_dma_chan_write(c
, CCR
, val
);
351 if (!__dma_omap15xx(od
->plat
->dma_attr
) && c
->cyclic
) {
352 val
= omap_dma_chan_read(c
, CLNK_CTRL
);
355 val
|= 1 << 14; /* set the STOP_LNK bit */
357 val
&= ~CLNK_CTRL_ENABLE_LNK
;
359 omap_dma_chan_write(c
, CLNK_CTRL
, val
);
363 static void omap_dma_start_sg(struct omap_chan
*c
, struct omap_desc
*d
,
366 struct omap_sg
*sg
= d
->sg
+ idx
;
367 unsigned cxsa
, cxei
, cxfi
;
369 if (d
->dir
== DMA_DEV_TO_MEM
|| d
->dir
== DMA_MEM_TO_MEM
) {
379 omap_dma_chan_write(c
, cxsa
, sg
->addr
);
380 omap_dma_chan_write(c
, cxei
, 0);
381 omap_dma_chan_write(c
, cxfi
, 0);
382 omap_dma_chan_write(c
, CEN
, sg
->en
);
383 omap_dma_chan_write(c
, CFN
, sg
->fn
);
385 omap_dma_start(c
, d
);
388 static void omap_dma_start_desc(struct omap_chan
*c
)
390 struct virt_dma_desc
*vd
= vchan_next_desc(&c
->vc
);
392 unsigned cxsa
, cxei
, cxfi
;
401 c
->desc
= d
= to_omap_dma_desc(&vd
->tx
);
405 * This provides the necessary barrier to ensure data held in
406 * DMA coherent memory is visible to the DMA engine prior to
407 * the transfer starting.
411 omap_dma_chan_write(c
, CCR
, d
->ccr
);
413 omap_dma_chan_write(c
, CCR2
, d
->ccr
>> 16);
415 if (d
->dir
== DMA_DEV_TO_MEM
|| d
->dir
== DMA_MEM_TO_MEM
) {
425 omap_dma_chan_write(c
, cxsa
, d
->dev_addr
);
426 omap_dma_chan_write(c
, cxei
, 0);
427 omap_dma_chan_write(c
, cxfi
, d
->fi
);
428 omap_dma_chan_write(c
, CSDP
, d
->csdp
);
429 omap_dma_chan_write(c
, CLNK_CTRL
, d
->clnk_ctrl
);
431 omap_dma_start_sg(c
, d
, 0);
434 static void omap_dma_callback(int ch
, u16 status
, void *data
)
436 struct omap_chan
*c
= data
;
440 spin_lock_irqsave(&c
->vc
.lock
, flags
);
444 if (++c
->sgidx
< d
->sglen
) {
445 omap_dma_start_sg(c
, d
, c
->sgidx
);
447 omap_dma_start_desc(c
);
448 vchan_cookie_complete(&d
->vd
);
451 vchan_cyclic_callback(&d
->vd
);
454 spin_unlock_irqrestore(&c
->vc
.lock
, flags
);
458 * This callback schedules all pending channels. We could be more
459 * clever here by postponing allocation of the real DMA channels to
460 * this point, and freeing them when our virtual channel becomes idle.
462 * We would then need to deal with 'all channels in-use'
464 static void omap_dma_sched(unsigned long data
)
466 struct omap_dmadev
*d
= (struct omap_dmadev
*)data
;
469 spin_lock_irq(&d
->lock
);
470 list_splice_tail_init(&d
->pending
, &head
);
471 spin_unlock_irq(&d
->lock
);
473 while (!list_empty(&head
)) {
474 struct omap_chan
*c
= list_first_entry(&head
,
475 struct omap_chan
, node
);
477 spin_lock_irq(&c
->vc
.lock
);
478 list_del_init(&c
->node
);
479 omap_dma_start_desc(c
);
480 spin_unlock_irq(&c
->vc
.lock
);
484 static irqreturn_t
omap_dma_irq(int irq
, void *devid
)
486 struct omap_dmadev
*od
= devid
;
487 unsigned status
, channel
;
489 spin_lock(&od
->irq_lock
);
491 status
= omap_dma_glbl_read(od
, IRQSTATUS_L1
);
492 status
&= od
->irq_enable_mask
;
494 spin_unlock(&od
->irq_lock
);
498 while ((channel
= ffs(status
)) != 0) {
506 c
= od
->lch_map
[channel
];
508 /* This should never happen */
509 dev_err(od
->ddev
.dev
, "invalid channel %u\n", channel
);
513 csr
= omap_dma_get_csr(c
);
514 omap_dma_glbl_write(od
, IRQSTATUS_L1
, mask
);
516 omap_dma_callback(channel
, csr
, c
);
519 spin_unlock(&od
->irq_lock
);
524 static int omap_dma_alloc_chan_resources(struct dma_chan
*chan
)
526 struct omap_dmadev
*od
= to_omap_dma_dev(chan
->device
);
527 struct omap_chan
*c
= to_omap_dma_chan(chan
);
531 ret
= omap_request_dma(c
->dma_sig
, "DMA engine",
532 omap_dma_callback
, c
, &c
->dma_ch
);
534 ret
= omap_request_dma(c
->dma_sig
, "DMA engine", NULL
, NULL
,
538 dev_dbg(od
->ddev
.dev
, "allocating channel %u for %u\n",
539 c
->dma_ch
, c
->dma_sig
);
542 omap_dma_assign(od
, c
, c
->dma_ch
);
547 spin_lock_irq(&od
->irq_lock
);
548 val
= BIT(c
->dma_ch
);
549 omap_dma_glbl_write(od
, IRQSTATUS_L1
, val
);
550 od
->irq_enable_mask
|= val
;
551 omap_dma_glbl_write(od
, IRQENABLE_L1
, od
->irq_enable_mask
);
553 val
= omap_dma_glbl_read(od
, IRQENABLE_L0
);
554 val
&= ~BIT(c
->dma_ch
);
555 omap_dma_glbl_write(od
, IRQENABLE_L0
, val
);
556 spin_unlock_irq(&od
->irq_lock
);
561 if (__dma_omap16xx(od
->plat
->dma_attr
)) {
562 c
->ccr
= CCR_OMAP31_DISABLE
;
563 /* Duplicate what plat-omap/dma.c does */
564 c
->ccr
|= c
->dma_ch
+ 1;
566 c
->ccr
= c
->dma_sig
& 0x1f;
569 c
->ccr
= c
->dma_sig
& 0x1f;
570 c
->ccr
|= (c
->dma_sig
& ~0x1f) << 14;
572 if (od
->plat
->errata
& DMA_ERRATA_IFRAME_BUFFERING
)
573 c
->ccr
|= CCR_BUFFERING_DISABLE
;
578 static void omap_dma_free_chan_resources(struct dma_chan
*chan
)
580 struct omap_dmadev
*od
= to_omap_dma_dev(chan
->device
);
581 struct omap_chan
*c
= to_omap_dma_chan(chan
);
584 spin_lock_irq(&od
->irq_lock
);
585 od
->irq_enable_mask
&= ~BIT(c
->dma_ch
);
586 omap_dma_glbl_write(od
, IRQENABLE_L1
, od
->irq_enable_mask
);
587 spin_unlock_irq(&od
->irq_lock
);
590 c
->channel_base
= NULL
;
591 od
->lch_map
[c
->dma_ch
] = NULL
;
592 vchan_free_chan_resources(&c
->vc
);
593 omap_free_dma(c
->dma_ch
);
595 dev_dbg(od
->ddev
.dev
, "freeing channel for %u\n", c
->dma_sig
);
599 static size_t omap_dma_sg_size(struct omap_sg
*sg
)
601 return sg
->en
* sg
->fn
;
604 static size_t omap_dma_desc_size(struct omap_desc
*d
)
609 for (size
= i
= 0; i
< d
->sglen
; i
++)
610 size
+= omap_dma_sg_size(&d
->sg
[i
]);
612 return size
* es_bytes
[d
->es
];
615 static size_t omap_dma_desc_size_pos(struct omap_desc
*d
, dma_addr_t addr
)
618 size_t size
, es_size
= es_bytes
[d
->es
];
620 for (size
= i
= 0; i
< d
->sglen
; i
++) {
621 size_t this_size
= omap_dma_sg_size(&d
->sg
[i
]) * es_size
;
625 else if (addr
>= d
->sg
[i
].addr
&&
626 addr
< d
->sg
[i
].addr
+ this_size
)
627 size
+= d
->sg
[i
].addr
+ this_size
- addr
;
633 * OMAP 3.2/3.3 erratum: sometimes 0 is returned if CSAC/CDAC is
634 * read before the DMA controller finished disabling the channel.
636 static uint32_t omap_dma_chan_read_3_3(struct omap_chan
*c
, unsigned reg
)
638 struct omap_dmadev
*od
= to_omap_dma_dev(c
->vc
.chan
.device
);
641 val
= omap_dma_chan_read(c
, reg
);
642 if (val
== 0 && od
->plat
->errata
& DMA_ERRATA_3_3
)
643 val
= omap_dma_chan_read(c
, reg
);
648 static dma_addr_t
omap_dma_get_src_pos(struct omap_chan
*c
)
650 struct omap_dmadev
*od
= to_omap_dma_dev(c
->vc
.chan
.device
);
651 dma_addr_t addr
, cdac
;
653 if (__dma_omap15xx(od
->plat
->dma_attr
)) {
654 addr
= omap_dma_chan_read(c
, CPC
);
656 addr
= omap_dma_chan_read_3_3(c
, CSAC
);
657 cdac
= omap_dma_chan_read_3_3(c
, CDAC
);
660 * CDAC == 0 indicates that the DMA transfer on the channel has
661 * not been started (no data has been transferred so far).
662 * Return the programmed source start address in this case.
665 addr
= omap_dma_chan_read(c
, CSSA
);
669 addr
|= omap_dma_chan_read(c
, CSSA
) & 0xffff0000;
674 static dma_addr_t
omap_dma_get_dst_pos(struct omap_chan
*c
)
676 struct omap_dmadev
*od
= to_omap_dma_dev(c
->vc
.chan
.device
);
679 if (__dma_omap15xx(od
->plat
->dma_attr
)) {
680 addr
= omap_dma_chan_read(c
, CPC
);
682 addr
= omap_dma_chan_read_3_3(c
, CDAC
);
685 * CDAC == 0 indicates that the DMA transfer on the channel
686 * has not been started (no data has been transferred so
687 * far). Return the programmed destination start address in
691 addr
= omap_dma_chan_read(c
, CDSA
);
695 addr
|= omap_dma_chan_read(c
, CDSA
) & 0xffff0000;
700 static enum dma_status
omap_dma_tx_status(struct dma_chan
*chan
,
701 dma_cookie_t cookie
, struct dma_tx_state
*txstate
)
703 struct omap_chan
*c
= to_omap_dma_chan(chan
);
704 struct virt_dma_desc
*vd
;
708 ret
= dma_cookie_status(chan
, cookie
, txstate
);
709 if (ret
== DMA_COMPLETE
|| !txstate
)
712 spin_lock_irqsave(&c
->vc
.lock
, flags
);
713 vd
= vchan_find_desc(&c
->vc
, cookie
);
715 txstate
->residue
= omap_dma_desc_size(to_omap_dma_desc(&vd
->tx
));
716 } else if (c
->desc
&& c
->desc
->vd
.tx
.cookie
== cookie
) {
717 struct omap_desc
*d
= c
->desc
;
720 if (d
->dir
== DMA_MEM_TO_DEV
)
721 pos
= omap_dma_get_src_pos(c
);
722 else if (d
->dir
== DMA_DEV_TO_MEM
)
723 pos
= omap_dma_get_dst_pos(c
);
727 txstate
->residue
= omap_dma_desc_size_pos(d
, pos
);
729 txstate
->residue
= 0;
731 spin_unlock_irqrestore(&c
->vc
.lock
, flags
);
736 static void omap_dma_issue_pending(struct dma_chan
*chan
)
738 struct omap_chan
*c
= to_omap_dma_chan(chan
);
741 spin_lock_irqsave(&c
->vc
.lock
, flags
);
742 if (vchan_issue_pending(&c
->vc
) && !c
->desc
) {
744 * c->cyclic is used only by audio and in this case the DMA need
745 * to be started without delay.
748 struct omap_dmadev
*d
= to_omap_dma_dev(chan
->device
);
750 if (list_empty(&c
->node
))
751 list_add_tail(&c
->node
, &d
->pending
);
752 spin_unlock(&d
->lock
);
753 tasklet_schedule(&d
->task
);
755 omap_dma_start_desc(c
);
758 spin_unlock_irqrestore(&c
->vc
.lock
, flags
);
761 static struct dma_async_tx_descriptor
*omap_dma_prep_slave_sg(
762 struct dma_chan
*chan
, struct scatterlist
*sgl
, unsigned sglen
,
763 enum dma_transfer_direction dir
, unsigned long tx_flags
, void *context
)
765 struct omap_dmadev
*od
= to_omap_dma_dev(chan
->device
);
766 struct omap_chan
*c
= to_omap_dma_chan(chan
);
767 enum dma_slave_buswidth dev_width
;
768 struct scatterlist
*sgent
;
771 unsigned i
, j
= 0, es
, en
, frame_bytes
;
774 if (dir
== DMA_DEV_TO_MEM
) {
775 dev_addr
= c
->cfg
.src_addr
;
776 dev_width
= c
->cfg
.src_addr_width
;
777 burst
= c
->cfg
.src_maxburst
;
778 } else if (dir
== DMA_MEM_TO_DEV
) {
779 dev_addr
= c
->cfg
.dst_addr
;
780 dev_width
= c
->cfg
.dst_addr_width
;
781 burst
= c
->cfg
.dst_maxburst
;
783 dev_err(chan
->device
->dev
, "%s: bad direction?\n", __func__
);
787 /* Bus width translates to the element size (ES) */
789 case DMA_SLAVE_BUSWIDTH_1_BYTE
:
790 es
= CSDP_DATA_TYPE_8
;
792 case DMA_SLAVE_BUSWIDTH_2_BYTES
:
793 es
= CSDP_DATA_TYPE_16
;
795 case DMA_SLAVE_BUSWIDTH_4_BYTES
:
796 es
= CSDP_DATA_TYPE_32
;
798 default: /* not reached */
802 /* Now allocate and setup the descriptor. */
803 d
= kzalloc(sizeof(*d
) + sglen
* sizeof(d
->sg
[0]), GFP_ATOMIC
);
808 d
->dev_addr
= dev_addr
;
811 d
->ccr
= c
->ccr
| CCR_SYNC_FRAME
;
812 if (dir
== DMA_DEV_TO_MEM
)
813 d
->ccr
|= CCR_DST_AMODE_POSTINC
| CCR_SRC_AMODE_CONSTANT
;
815 d
->ccr
|= CCR_DST_AMODE_CONSTANT
| CCR_SRC_AMODE_POSTINC
;
817 d
->cicr
= CICR_DROP_IE
| CICR_BLOCK_IE
;
821 d
->cicr
|= CICR_TOUT_IE
;
823 if (dir
== DMA_DEV_TO_MEM
)
824 d
->csdp
|= CSDP_DST_PORT_EMIFF
| CSDP_SRC_PORT_TIPB
;
826 d
->csdp
|= CSDP_DST_PORT_TIPB
| CSDP_SRC_PORT_EMIFF
;
828 if (dir
== DMA_DEV_TO_MEM
)
829 d
->ccr
|= CCR_TRIGGER_SRC
;
831 d
->cicr
|= CICR_MISALIGNED_ERR_IE
| CICR_TRANS_ERR_IE
;
833 if (od
->plat
->errata
& DMA_ERRATA_PARALLEL_CHANNELS
)
834 d
->clnk_ctrl
= c
->dma_ch
;
837 * Build our scatterlist entries: each contains the address,
838 * the number of elements (EN) in each frame, and the number of
839 * frames (FN). Number of bytes for this entry = ES * EN * FN.
841 * Burst size translates to number of elements with frame sync.
842 * Note: DMA engine defines burst to be the number of dev-width
846 frame_bytes
= es_bytes
[es
] * en
;
847 for_each_sg(sgl
, sgent
, sglen
, i
) {
848 d
->sg
[j
].addr
= sg_dma_address(sgent
);
850 d
->sg
[j
].fn
= sg_dma_len(sgent
) / frame_bytes
;
856 return vchan_tx_prep(&c
->vc
, &d
->vd
, tx_flags
);
859 static struct dma_async_tx_descriptor
*omap_dma_prep_dma_cyclic(
860 struct dma_chan
*chan
, dma_addr_t buf_addr
, size_t buf_len
,
861 size_t period_len
, enum dma_transfer_direction dir
, unsigned long flags
)
863 struct omap_dmadev
*od
= to_omap_dma_dev(chan
->device
);
864 struct omap_chan
*c
= to_omap_dma_chan(chan
);
865 enum dma_slave_buswidth dev_width
;
871 if (dir
== DMA_DEV_TO_MEM
) {
872 dev_addr
= c
->cfg
.src_addr
;
873 dev_width
= c
->cfg
.src_addr_width
;
874 burst
= c
->cfg
.src_maxburst
;
875 } else if (dir
== DMA_MEM_TO_DEV
) {
876 dev_addr
= c
->cfg
.dst_addr
;
877 dev_width
= c
->cfg
.dst_addr_width
;
878 burst
= c
->cfg
.dst_maxburst
;
880 dev_err(chan
->device
->dev
, "%s: bad direction?\n", __func__
);
884 /* Bus width translates to the element size (ES) */
886 case DMA_SLAVE_BUSWIDTH_1_BYTE
:
887 es
= CSDP_DATA_TYPE_8
;
889 case DMA_SLAVE_BUSWIDTH_2_BYTES
:
890 es
= CSDP_DATA_TYPE_16
;
892 case DMA_SLAVE_BUSWIDTH_4_BYTES
:
893 es
= CSDP_DATA_TYPE_32
;
895 default: /* not reached */
899 /* Now allocate and setup the descriptor. */
900 d
= kzalloc(sizeof(*d
) + sizeof(d
->sg
[0]), GFP_ATOMIC
);
905 d
->dev_addr
= dev_addr
;
908 d
->sg
[0].addr
= buf_addr
;
909 d
->sg
[0].en
= period_len
/ es_bytes
[es
];
910 d
->sg
[0].fn
= buf_len
/ period_len
;
914 if (dir
== DMA_DEV_TO_MEM
)
915 d
->ccr
|= CCR_DST_AMODE_POSTINC
| CCR_SRC_AMODE_CONSTANT
;
917 d
->ccr
|= CCR_DST_AMODE_CONSTANT
| CCR_SRC_AMODE_POSTINC
;
919 d
->cicr
= CICR_DROP_IE
;
920 if (flags
& DMA_PREP_INTERRUPT
)
921 d
->cicr
|= CICR_FRAME_IE
;
926 d
->cicr
|= CICR_TOUT_IE
;
928 if (dir
== DMA_DEV_TO_MEM
)
929 d
->csdp
|= CSDP_DST_PORT_EMIFF
| CSDP_SRC_PORT_MPUI
;
931 d
->csdp
|= CSDP_DST_PORT_MPUI
| CSDP_SRC_PORT_EMIFF
;
934 d
->ccr
|= CCR_SYNC_PACKET
;
936 d
->ccr
|= CCR_SYNC_ELEMENT
;
938 if (dir
== DMA_DEV_TO_MEM
)
939 d
->ccr
|= CCR_TRIGGER_SRC
;
941 d
->cicr
|= CICR_MISALIGNED_ERR_IE
| CICR_TRANS_ERR_IE
;
943 d
->csdp
|= CSDP_DST_BURST_64
| CSDP_SRC_BURST_64
;
946 if (__dma_omap15xx(od
->plat
->dma_attr
))
947 d
->ccr
|= CCR_AUTO_INIT
| CCR_REPEAT
;
949 d
->clnk_ctrl
= c
->dma_ch
| CLNK_CTRL_ENABLE_LNK
;
953 return vchan_tx_prep(&c
->vc
, &d
->vd
, flags
);
956 static struct dma_async_tx_descriptor
*omap_dma_prep_dma_memcpy(
957 struct dma_chan
*chan
, dma_addr_t dest
, dma_addr_t src
,
958 size_t len
, unsigned long tx_flags
)
960 struct omap_chan
*c
= to_omap_dma_chan(chan
);
964 d
= kzalloc(sizeof(*d
) + sizeof(d
->sg
[0]), GFP_ATOMIC
);
968 data_type
= __ffs((src
| dest
| len
));
969 if (data_type
> CSDP_DATA_TYPE_32
)
970 data_type
= CSDP_DATA_TYPE_32
;
972 d
->dir
= DMA_MEM_TO_MEM
;
976 d
->sg
[0].en
= len
/ BIT(data_type
);
978 d
->sg
[0].addr
= dest
;
981 d
->ccr
|= CCR_DST_AMODE_POSTINC
| CCR_SRC_AMODE_POSTINC
;
983 d
->cicr
= CICR_DROP_IE
;
984 if (tx_flags
& DMA_PREP_INTERRUPT
)
985 d
->cicr
|= CICR_FRAME_IE
;
990 d
->cicr
|= CICR_TOUT_IE
;
991 d
->csdp
|= CSDP_DST_PORT_EMIFF
| CSDP_SRC_PORT_EMIFF
;
993 d
->csdp
|= CSDP_DST_PACKED
| CSDP_SRC_PACKED
;
994 d
->cicr
|= CICR_MISALIGNED_ERR_IE
| CICR_TRANS_ERR_IE
;
995 d
->csdp
|= CSDP_DST_BURST_64
| CSDP_SRC_BURST_64
;
998 return vchan_tx_prep(&c
->vc
, &d
->vd
, tx_flags
);
1001 static int omap_dma_slave_config(struct dma_chan
*chan
, struct dma_slave_config
*cfg
)
1003 struct omap_chan
*c
= to_omap_dma_chan(chan
);
1005 if (cfg
->src_addr_width
== DMA_SLAVE_BUSWIDTH_8_BYTES
||
1006 cfg
->dst_addr_width
== DMA_SLAVE_BUSWIDTH_8_BYTES
)
1009 memcpy(&c
->cfg
, cfg
, sizeof(c
->cfg
));
1014 static int omap_dma_terminate_all(struct dma_chan
*chan
)
1016 struct omap_chan
*c
= to_omap_dma_chan(chan
);
1017 struct omap_dmadev
*d
= to_omap_dma_dev(c
->vc
.chan
.device
);
1018 unsigned long flags
;
1021 spin_lock_irqsave(&c
->vc
.lock
, flags
);
1023 /* Prevent this channel being scheduled */
1024 spin_lock(&d
->lock
);
1025 list_del_init(&c
->node
);
1026 spin_unlock(&d
->lock
);
1029 * Stop DMA activity: we assume the callback will not be called
1030 * after omap_dma_stop() returns (even if it does, it will see
1031 * c->desc is NULL and exit.)
1034 omap_dma_desc_free(&c
->desc
->vd
);
1036 /* Avoid stopping the dma twice */
1046 vchan_get_all_descriptors(&c
->vc
, &head
);
1047 spin_unlock_irqrestore(&c
->vc
.lock
, flags
);
1048 vchan_dma_desc_free_list(&c
->vc
, &head
);
1053 static int omap_dma_pause(struct dma_chan
*chan
)
1055 struct omap_chan
*c
= to_omap_dma_chan(chan
);
1057 /* Pause/Resume only allowed with cyclic mode */
1069 static int omap_dma_resume(struct dma_chan
*chan
)
1071 struct omap_chan
*c
= to_omap_dma_chan(chan
);
1073 /* Pause/Resume only allowed with cyclic mode */
1080 /* Restore channel link register */
1081 omap_dma_chan_write(c
, CLNK_CTRL
, c
->desc
->clnk_ctrl
);
1083 omap_dma_start(c
, c
->desc
);
1090 static int omap_dma_chan_init(struct omap_dmadev
*od
)
1092 struct omap_chan
*c
;
1094 c
= kzalloc(sizeof(*c
), GFP_KERNEL
);
1098 c
->reg_map
= od
->reg_map
;
1099 c
->vc
.desc_free
= omap_dma_desc_free
;
1100 vchan_init(&c
->vc
, &od
->ddev
);
1101 INIT_LIST_HEAD(&c
->node
);
1106 static void omap_dma_free(struct omap_dmadev
*od
)
1108 tasklet_kill(&od
->task
);
1109 while (!list_empty(&od
->ddev
.channels
)) {
1110 struct omap_chan
*c
= list_first_entry(&od
->ddev
.channels
,
1111 struct omap_chan
, vc
.chan
.device_node
);
1113 list_del(&c
->vc
.chan
.device_node
);
1114 tasklet_kill(&c
->vc
.task
);
1119 #define OMAP_DMA_BUSWIDTHS (BIT(DMA_SLAVE_BUSWIDTH_1_BYTE) | \
1120 BIT(DMA_SLAVE_BUSWIDTH_2_BYTES) | \
1121 BIT(DMA_SLAVE_BUSWIDTH_4_BYTES))
1123 static int omap_dma_probe(struct platform_device
*pdev
)
1125 struct omap_dmadev
*od
;
1126 struct resource
*res
;
1129 od
= devm_kzalloc(&pdev
->dev
, sizeof(*od
), GFP_KERNEL
);
1133 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
1134 od
->base
= devm_ioremap_resource(&pdev
->dev
, res
);
1135 if (IS_ERR(od
->base
))
1136 return PTR_ERR(od
->base
);
1138 od
->plat
= omap_get_plat_info();
1140 return -EPROBE_DEFER
;
1142 od
->reg_map
= od
->plat
->reg_map
;
1144 dma_cap_set(DMA_SLAVE
, od
->ddev
.cap_mask
);
1145 dma_cap_set(DMA_CYCLIC
, od
->ddev
.cap_mask
);
1146 dma_cap_set(DMA_MEMCPY
, od
->ddev
.cap_mask
);
1147 od
->ddev
.device_alloc_chan_resources
= omap_dma_alloc_chan_resources
;
1148 od
->ddev
.device_free_chan_resources
= omap_dma_free_chan_resources
;
1149 od
->ddev
.device_tx_status
= omap_dma_tx_status
;
1150 od
->ddev
.device_issue_pending
= omap_dma_issue_pending
;
1151 od
->ddev
.device_prep_slave_sg
= omap_dma_prep_slave_sg
;
1152 od
->ddev
.device_prep_dma_cyclic
= omap_dma_prep_dma_cyclic
;
1153 od
->ddev
.device_prep_dma_memcpy
= omap_dma_prep_dma_memcpy
;
1154 od
->ddev
.device_config
= omap_dma_slave_config
;
1155 od
->ddev
.device_pause
= omap_dma_pause
;
1156 od
->ddev
.device_resume
= omap_dma_resume
;
1157 od
->ddev
.device_terminate_all
= omap_dma_terminate_all
;
1158 od
->ddev
.src_addr_widths
= OMAP_DMA_BUSWIDTHS
;
1159 od
->ddev
.dst_addr_widths
= OMAP_DMA_BUSWIDTHS
;
1160 od
->ddev
.directions
= BIT(DMA_DEV_TO_MEM
) | BIT(DMA_MEM_TO_DEV
);
1161 od
->ddev
.residue_granularity
= DMA_RESIDUE_GRANULARITY_BURST
;
1162 od
->ddev
.dev
= &pdev
->dev
;
1163 INIT_LIST_HEAD(&od
->ddev
.channels
);
1164 INIT_LIST_HEAD(&od
->pending
);
1165 spin_lock_init(&od
->lock
);
1166 spin_lock_init(&od
->irq_lock
);
1168 tasklet_init(&od
->task
, omap_dma_sched
, (unsigned long)od
);
1170 od
->dma_requests
= OMAP_SDMA_REQUESTS
;
1171 if (pdev
->dev
.of_node
&& of_property_read_u32(pdev
->dev
.of_node
,
1173 &od
->dma_requests
)) {
1174 dev_info(&pdev
->dev
,
1175 "Missing dma-requests property, using %u.\n",
1176 OMAP_SDMA_REQUESTS
);
1179 for (i
= 0; i
< OMAP_SDMA_CHANNELS
; i
++) {
1180 rc
= omap_dma_chan_init(od
);
1187 irq
= platform_get_irq(pdev
, 1);
1189 dev_info(&pdev
->dev
, "failed to get L1 IRQ: %d\n", irq
);
1192 /* Disable all interrupts */
1193 od
->irq_enable_mask
= 0;
1194 omap_dma_glbl_write(od
, IRQENABLE_L1
, 0);
1196 rc
= devm_request_irq(&pdev
->dev
, irq
, omap_dma_irq
,
1197 IRQF_SHARED
, "omap-dma-engine", od
);
1202 rc
= dma_async_device_register(&od
->ddev
);
1204 pr_warn("OMAP-DMA: failed to register slave DMA engine device: %d\n",
1210 platform_set_drvdata(pdev
, od
);
1212 if (pdev
->dev
.of_node
) {
1213 omap_dma_info
.dma_cap
= od
->ddev
.cap_mask
;
1215 /* Device-tree DMA controller registration */
1216 rc
= of_dma_controller_register(pdev
->dev
.of_node
,
1217 of_dma_simple_xlate
, &omap_dma_info
);
1219 pr_warn("OMAP-DMA: failed to register DMA controller\n");
1220 dma_async_device_unregister(&od
->ddev
);
1225 dev_info(&pdev
->dev
, "OMAP DMA engine driver\n");
1230 static int omap_dma_remove(struct platform_device
*pdev
)
1232 struct omap_dmadev
*od
= platform_get_drvdata(pdev
);
1234 if (pdev
->dev
.of_node
)
1235 of_dma_controller_free(pdev
->dev
.of_node
);
1237 dma_async_device_unregister(&od
->ddev
);
1240 /* Disable all interrupts */
1241 omap_dma_glbl_write(od
, IRQENABLE_L0
, 0);
1249 static const struct of_device_id omap_dma_match
[] = {
1250 { .compatible
= "ti,omap2420-sdma", },
1251 { .compatible
= "ti,omap2430-sdma", },
1252 { .compatible
= "ti,omap3430-sdma", },
1253 { .compatible
= "ti,omap3630-sdma", },
1254 { .compatible
= "ti,omap4430-sdma", },
1257 MODULE_DEVICE_TABLE(of
, omap_dma_match
);
1259 static struct platform_driver omap_dma_driver
= {
1260 .probe
= omap_dma_probe
,
1261 .remove
= omap_dma_remove
,
1263 .name
= "omap-dma-engine",
1264 .of_match_table
= of_match_ptr(omap_dma_match
),
1268 bool omap_dma_filter_fn(struct dma_chan
*chan
, void *param
)
1270 if (chan
->device
->dev
->driver
== &omap_dma_driver
.driver
) {
1271 struct omap_dmadev
*od
= to_omap_dma_dev(chan
->device
);
1272 struct omap_chan
*c
= to_omap_dma_chan(chan
);
1273 unsigned req
= *(unsigned *)param
;
1275 if (req
<= od
->dma_requests
) {
1282 EXPORT_SYMBOL_GPL(omap_dma_filter_fn
);
1284 static int omap_dma_init(void)
1286 return platform_driver_register(&omap_dma_driver
);
1288 subsys_initcall(omap_dma_init
);
1290 static void __exit
omap_dma_exit(void)
1292 platform_driver_unregister(&omap_dma_driver
);
1294 module_exit(omap_dma_exit
);
1296 MODULE_AUTHOR("Russell King");
1297 MODULE_LICENSE("GPL");