581 lines
		
	
	
		
			17 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			581 lines
		
	
	
		
			17 KiB
		
	
	
	
		
			C
		
	
	
	
| // SPDX-License-Identifier: GPL-2.0+
 | |
| /*
 | |
|  * Enhanced Direct Memory Access (EDMA3) Controller
 | |
|  *
 | |
|  * (C) Copyright 2014
 | |
|  *     Texas Instruments Incorporated, <www.ti.com>
 | |
|  *
 | |
|  * Author: Ivan Khoronzhuk <ivan.khoronzhuk@ti.com>
 | |
|  */
 | |
| 
 | |
| #include <asm/io.h>
 | |
| #include <common.h>
 | |
| #include <dm.h>
 | |
| #include <dma-uclass.h>
 | |
| #include <asm/omap_common.h>
 | |
| #include <asm/ti-common/ti-edma3.h>
 | |
| 
 | |
| #define EDMA3_SL_BASE(slot)			(0x4000 + ((slot) << 5))
 | |
| #define EDMA3_SL_MAX_NUM			512
 | |
| #define EDMA3_SLOPT_FIFO_WIDTH_MASK		(0x7 << 8)
 | |
| 
 | |
| #define EDMA3_QCHMAP(ch)			0x0200 + ((ch) << 2)
 | |
| #define EDMA3_CHMAP_PARSET_MASK			0x1ff
 | |
| #define EDMA3_CHMAP_PARSET_SHIFT		0x5
 | |
| #define EDMA3_CHMAP_TRIGWORD_SHIFT		0x2
 | |
| 
 | |
| #define EDMA3_QEMCR				0x314
 | |
| #define EDMA3_IPR				0x1068
 | |
| #define EDMA3_IPRH				0x106c
 | |
| #define EDMA3_ICR				0x1070
 | |
| #define EDMA3_ICRH				0x1074
 | |
| #define EDMA3_QEECR				0x1088
 | |
| #define EDMA3_QEESR				0x108c
 | |
| #define EDMA3_QSECR				0x1094
 | |
| 
 | |
| #define EDMA_FILL_BUFFER_SIZE			512
 | |
| 
 | |
| struct ti_edma3_priv {
 | |
| 	u32 base;
 | |
| };
 | |
| 
 | |
| static u8 edma_fill_buffer[EDMA_FILL_BUFFER_SIZE] __aligned(ARCH_DMA_MINALIGN);
 | |
| 
 | |
| /**
 | |
|  * qedma3_start - start qdma on a channel
 | |
|  * @base: base address of edma
 | |
|  * @cfg: pinter to struct edma3_channel_config where you can set
 | |
|  * the slot number to associate with, the chnum, which corresponds
 | |
|  * your quick channel number 0-7, complete code - transfer complete code
 | |
|  * and trigger slot word - which has to correspond to the word number in
 | |
|  * edma3_slot_layout struct for generating event.
 | |
|  *
 | |
|  */
 | |
| void qedma3_start(u32 base, struct edma3_channel_config *cfg)
 | |
| {
 | |
| 	u32 qchmap;
 | |
| 
 | |
| 	/* Clear the pending int bit */
 | |
| 	if (cfg->complete_code < 32)
 | |
| 		__raw_writel(1 << cfg->complete_code, base + EDMA3_ICR);
 | |
| 	else
 | |
| 		__raw_writel(1 << cfg->complete_code, base + EDMA3_ICRH);
 | |
| 
 | |
| 	/* Map parameter set and trigger word 7 to quick channel */
 | |
| 	qchmap = ((EDMA3_CHMAP_PARSET_MASK & cfg->slot)
 | |
| 		  << EDMA3_CHMAP_PARSET_SHIFT) |
 | |
| 		  (cfg->trigger_slot_word << EDMA3_CHMAP_TRIGWORD_SHIFT);
 | |
| 
 | |
| 	__raw_writel(qchmap, base + EDMA3_QCHMAP(cfg->chnum));
 | |
| 
 | |
| 	/* Clear missed event if set*/
 | |
| 	__raw_writel(1 << cfg->chnum, base + EDMA3_QSECR);
 | |
| 	__raw_writel(1 << cfg->chnum, base + EDMA3_QEMCR);
 | |
| 
 | |
| 	/* Enable qdma channel event */
 | |
| 	__raw_writel(1 << cfg->chnum, base + EDMA3_QEESR);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * edma3_set_dest - set initial DMA destination address in parameter RAM slot
 | |
|  * @base: base address of edma
 | |
|  * @slot: parameter RAM slot being configured
 | |
|  * @dst: physical address of destination (memory, controller FIFO, etc)
 | |
|  * @addressMode: INCR, except in very rare cases
 | |
|  * @width: ignored unless @addressMode is FIFO, else specifies the
 | |
|  *	width to use when addressing the fifo (e.g. W8BIT, W32BIT)
 | |
|  *
 | |
|  * Note that the destination address is modified during the DMA transfer
 | |
|  * according to edma3_set_dest_index().
 | |
|  */
 | |
| void edma3_set_dest(u32 base, int slot, u32 dst, enum edma3_address_mode mode,
 | |
| 		    enum edma3_fifo_width width)
 | |
| {
 | |
| 	u32 opt;
 | |
| 	struct edma3_slot_layout *rg;
 | |
| 
 | |
| 	rg = (struct edma3_slot_layout *)(base + EDMA3_SL_BASE(slot));
 | |
| 
 | |
| 	opt = __raw_readl(&rg->opt);
 | |
| 	if (mode == FIFO)
 | |
| 		opt = (opt & EDMA3_SLOPT_FIFO_WIDTH_MASK) |
 | |
| 		       (EDMA3_SLOPT_DST_ADDR_CONST_MODE |
 | |
| 			EDMA3_SLOPT_FIFO_WIDTH_SET(width));
 | |
| 	else
 | |
| 		opt &= ~EDMA3_SLOPT_DST_ADDR_CONST_MODE;
 | |
| 
 | |
| 	__raw_writel(opt, &rg->opt);
 | |
| 	__raw_writel(dst, &rg->dst);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * edma3_set_dest_index - configure DMA destination address indexing
 | |
|  * @base: base address of edma
 | |
|  * @slot: parameter RAM slot being configured
 | |
|  * @bidx: byte offset between destination arrays in a frame
 | |
|  * @cidx: byte offset between destination frames in a block
 | |
|  *
 | |
|  * Offsets are specified to support either contiguous or discontiguous
 | |
|  * memory transfers, or repeated access to a hardware register, as needed.
 | |
|  * When accessing hardware registers, both offsets are normally zero.
 | |
|  */
 | |
| void edma3_set_dest_index(u32 base, unsigned slot, int bidx, int cidx)
 | |
| {
 | |
| 	u32 src_dst_bidx;
 | |
| 	u32 src_dst_cidx;
 | |
| 	struct edma3_slot_layout *rg;
 | |
| 
 | |
| 	rg = (struct edma3_slot_layout *)(base + EDMA3_SL_BASE(slot));
 | |
| 
 | |
| 	src_dst_bidx = __raw_readl(&rg->src_dst_bidx);
 | |
| 	src_dst_cidx = __raw_readl(&rg->src_dst_cidx);
 | |
| 
 | |
| 	__raw_writel((src_dst_bidx & 0x0000ffff) | (bidx << 16),
 | |
| 		     &rg->src_dst_bidx);
 | |
| 	__raw_writel((src_dst_cidx & 0x0000ffff) | (cidx << 16),
 | |
| 		     &rg->src_dst_cidx);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * edma3_set_dest_addr - set destination address for slot only
 | |
|  */
 | |
| void edma3_set_dest_addr(u32 base, int slot, u32 dst)
 | |
| {
 | |
| 	struct edma3_slot_layout *rg;
 | |
| 
 | |
| 	rg = (struct edma3_slot_layout *)(base + EDMA3_SL_BASE(slot));
 | |
| 	__raw_writel(dst, &rg->dst);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * edma3_set_src - set initial DMA source address in parameter RAM slot
 | |
|  * @base: base address of edma
 | |
|  * @slot: parameter RAM slot being configured
 | |
|  * @src_port: physical address of source (memory, controller FIFO, etc)
 | |
|  * @mode: INCR, except in very rare cases
 | |
|  * @width: ignored unless @addressMode is FIFO, else specifies the
 | |
|  *	width to use when addressing the fifo (e.g. W8BIT, W32BIT)
 | |
|  *
 | |
|  * Note that the source address is modified during the DMA transfer
 | |
|  * according to edma3_set_src_index().
 | |
|  */
 | |
| void edma3_set_src(u32 base, int slot, u32 src, enum edma3_address_mode mode,
 | |
| 		   enum edma3_fifo_width width)
 | |
| {
 | |
| 	u32 opt;
 | |
| 	struct edma3_slot_layout *rg;
 | |
| 
 | |
| 	rg = (struct edma3_slot_layout *)(base + EDMA3_SL_BASE(slot));
 | |
| 
 | |
| 	opt = __raw_readl(&rg->opt);
 | |
| 	if (mode == FIFO)
 | |
| 		opt = (opt & EDMA3_SLOPT_FIFO_WIDTH_MASK) |
 | |
| 		       (EDMA3_SLOPT_DST_ADDR_CONST_MODE |
 | |
| 			EDMA3_SLOPT_FIFO_WIDTH_SET(width));
 | |
| 	else
 | |
| 		opt &= ~EDMA3_SLOPT_DST_ADDR_CONST_MODE;
 | |
| 
 | |
| 	__raw_writel(opt, &rg->opt);
 | |
| 	__raw_writel(src, &rg->src);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * edma3_set_src_index - configure DMA source address indexing
 | |
|  * @base: base address of edma
 | |
|  * @slot: parameter RAM slot being configured
 | |
|  * @bidx: byte offset between source arrays in a frame
 | |
|  * @cidx: byte offset between source frames in a block
 | |
|  *
 | |
|  * Offsets are specified to support either contiguous or discontiguous
 | |
|  * memory transfers, or repeated access to a hardware register, as needed.
 | |
|  * When accessing hardware registers, both offsets are normally zero.
 | |
|  */
 | |
| void edma3_set_src_index(u32 base, unsigned slot, int bidx, int cidx)
 | |
| {
 | |
| 	u32 src_dst_bidx;
 | |
| 	u32 src_dst_cidx;
 | |
| 	struct edma3_slot_layout *rg;
 | |
| 
 | |
| 	rg = (struct edma3_slot_layout *)(base + EDMA3_SL_BASE(slot));
 | |
| 
 | |
| 	src_dst_bidx = __raw_readl(&rg->src_dst_bidx);
 | |
| 	src_dst_cidx = __raw_readl(&rg->src_dst_cidx);
 | |
| 
 | |
| 	__raw_writel((src_dst_bidx & 0xffff0000) | bidx,
 | |
| 		     &rg->src_dst_bidx);
 | |
| 	__raw_writel((src_dst_cidx & 0xffff0000) | cidx,
 | |
| 		     &rg->src_dst_cidx);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * edma3_set_src_addr - set source address for slot only
 | |
|  */
 | |
| void edma3_set_src_addr(u32 base, int slot, u32 src)
 | |
| {
 | |
| 	struct edma3_slot_layout *rg;
 | |
| 
 | |
| 	rg = (struct edma3_slot_layout *)(base + EDMA3_SL_BASE(slot));
 | |
| 	__raw_writel(src, &rg->src);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * edma3_set_transfer_params - configure DMA transfer parameters
 | |
|  * @base: base address of edma
 | |
|  * @slot: parameter RAM slot being configured
 | |
|  * @acnt: how many bytes per array (at least one)
 | |
|  * @bcnt: how many arrays per frame (at least one)
 | |
|  * @ccnt: how many frames per block (at least one)
 | |
|  * @bcnt_rld: used only for A-Synchronized transfers; this specifies
 | |
|  *	the value to reload into bcnt when it decrements to zero
 | |
|  * @sync_mode: ASYNC or ABSYNC
 | |
|  *
 | |
|  * See the EDMA3 documentation to understand how to configure and link
 | |
|  * transfers using the fields in PaRAM slots.  If you are not doing it
 | |
|  * all at once with edma3_write_slot(), you will use this routine
 | |
|  * plus two calls each for source and destination, setting the initial
 | |
|  * address and saying how to index that address.
 | |
|  *
 | |
|  * An example of an A-Synchronized transfer is a serial link using a
 | |
|  * single word shift register.  In that case, @acnt would be equal to
 | |
|  * that word size; the serial controller issues a DMA synchronization
 | |
|  * event to transfer each word, and memory access by the DMA transfer
 | |
|  * controller will be word-at-a-time.
 | |
|  *
 | |
|  * An example of an AB-Synchronized transfer is a device using a FIFO.
 | |
|  * In that case, @acnt equals the FIFO width and @bcnt equals its depth.
 | |
|  * The controller with the FIFO issues DMA synchronization events when
 | |
|  * the FIFO threshold is reached, and the DMA transfer controller will
 | |
|  * transfer one frame to (or from) the FIFO.  It will probably use
 | |
|  * efficient burst modes to access memory.
 | |
|  */
 | |
| void edma3_set_transfer_params(u32 base, int slot, int acnt,
 | |
| 			       int bcnt, int ccnt, u16 bcnt_rld,
 | |
| 			       enum edma3_sync_dimension sync_mode)
 | |
| {
 | |
| 	u32 opt;
 | |
| 	u32 link_bcntrld;
 | |
| 	struct edma3_slot_layout *rg;
 | |
| 
 | |
| 	rg = (struct edma3_slot_layout *)(base + EDMA3_SL_BASE(slot));
 | |
| 
 | |
| 	link_bcntrld = __raw_readl(&rg->link_bcntrld);
 | |
| 
 | |
| 	__raw_writel((bcnt_rld << 16) | (0x0000ffff & link_bcntrld),
 | |
| 		     &rg->link_bcntrld);
 | |
| 
 | |
| 	opt = __raw_readl(&rg->opt);
 | |
| 	if (sync_mode == ASYNC)
 | |
| 		__raw_writel(opt & ~EDMA3_SLOPT_AB_SYNC, &rg->opt);
 | |
| 	else
 | |
| 		__raw_writel(opt | EDMA3_SLOPT_AB_SYNC, &rg->opt);
 | |
| 
 | |
| 	/* Set the acount, bcount, ccount registers */
 | |
| 	__raw_writel((bcnt << 16) | (acnt & 0xffff), &rg->a_b_cnt);
 | |
| 	__raw_writel(0xffff & ccnt, &rg->ccnt);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * edma3_write_slot - write parameter RAM data for slot
 | |
|  * @base: base address of edma
 | |
|  * @slot: number of parameter RAM slot being modified
 | |
|  * @param: data to be written into parameter RAM slot
 | |
|  *
 | |
|  * Use this to assign all parameters of a transfer at once.  This
 | |
|  * allows more efficient setup of transfers than issuing multiple
 | |
|  * calls to set up those parameters in small pieces, and provides
 | |
|  * complete control over all transfer options.
 | |
|  */
 | |
| void edma3_write_slot(u32 base, int slot, struct edma3_slot_layout *param)
 | |
| {
 | |
| 	int i;
 | |
| 	u32 *p = (u32 *)param;
 | |
| 	u32 *addr = (u32 *)(base + EDMA3_SL_BASE(slot));
 | |
| 
 | |
| 	for (i = 0; i < sizeof(struct edma3_slot_layout)/4; i += 4)
 | |
| 		__raw_writel(*p++, addr++);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * edma3_read_slot - read parameter RAM data from slot
 | |
|  * @base: base address of edma
 | |
|  * @slot: number of parameter RAM slot being copied
 | |
|  * @param: where to store copy of parameter RAM data
 | |
|  *
 | |
|  * Use this to read data from a parameter RAM slot, perhaps to
 | |
|  * save them as a template for later reuse.
 | |
|  */
 | |
| void edma3_read_slot(u32 base, int slot, struct edma3_slot_layout *param)
 | |
| {
 | |
| 	int i;
 | |
| 	u32 *p = (u32 *)param;
 | |
| 	u32 *addr = (u32 *)(base + EDMA3_SL_BASE(slot));
 | |
| 
 | |
| 	for (i = 0; i < sizeof(struct edma3_slot_layout)/4; i += 4)
 | |
| 		*p++ = __raw_readl(addr++);
 | |
| }
 | |
| 
 | |
| void edma3_slot_configure(u32 base, int slot, struct edma3_slot_config *cfg)
 | |
| {
 | |
| 	struct edma3_slot_layout *rg;
 | |
| 
 | |
| 	rg = (struct edma3_slot_layout *)(base + EDMA3_SL_BASE(slot));
 | |
| 
 | |
| 	__raw_writel(cfg->opt, &rg->opt);
 | |
| 	__raw_writel(cfg->src, &rg->src);
 | |
| 	__raw_writel((cfg->bcnt << 16) | (cfg->acnt & 0xffff), &rg->a_b_cnt);
 | |
| 	__raw_writel(cfg->dst, &rg->dst);
 | |
| 	__raw_writel((cfg->dst_bidx << 16) |
 | |
| 		     (cfg->src_bidx & 0xffff), &rg->src_dst_bidx);
 | |
| 	__raw_writel((cfg->bcntrld << 16) |
 | |
| 		     (cfg->link & 0xffff), &rg->link_bcntrld);
 | |
| 	__raw_writel((cfg->dst_cidx << 16) |
 | |
| 		     (cfg->src_cidx & 0xffff), &rg->src_dst_cidx);
 | |
| 	__raw_writel(0xffff & cfg->ccnt, &rg->ccnt);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * edma3_check_for_transfer - check if transfer coplete by checking
 | |
|  * interrupt pending bit. Clear interrupt pending bit if complete.
 | |
|  * @base: base address of edma
 | |
|  * @cfg: pinter to struct edma3_channel_config which was passed
 | |
|  * to qedma3_start when you started qdma channel
 | |
|  *
 | |
|  * Return 0 if complete, 1 if not.
 | |
|  */
 | |
| int edma3_check_for_transfer(u32 base, struct edma3_channel_config *cfg)
 | |
| {
 | |
| 	u32 inum;
 | |
| 	u32 ipr_base;
 | |
| 	u32 icr_base;
 | |
| 
 | |
| 	if (cfg->complete_code < 32) {
 | |
| 		ipr_base = base + EDMA3_IPR;
 | |
| 		icr_base = base + EDMA3_ICR;
 | |
| 		inum = 1 << cfg->complete_code;
 | |
| 	} else {
 | |
| 		ipr_base = base + EDMA3_IPRH;
 | |
| 		icr_base = base + EDMA3_ICRH;
 | |
| 		inum = 1 << (cfg->complete_code - 32);
 | |
| 	}
 | |
| 
 | |
| 	/* check complete interrupt */
 | |
| 	if (!(__raw_readl(ipr_base) & inum))
 | |
| 		return 1;
 | |
| 
 | |
| 	/* clean up the pending int bit */
 | |
| 	__raw_writel(inum, icr_base);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * qedma3_stop - stops dma on the channel passed
 | |
|  * @base: base address of edma
 | |
|  * @cfg: pinter to struct edma3_channel_config which was passed
 | |
|  * to qedma3_start when you started qdma channel
 | |
|  */
 | |
| void qedma3_stop(u32 base, struct edma3_channel_config *cfg)
 | |
| {
 | |
| 	/* Disable qdma channel event */
 | |
| 	__raw_writel(1 << cfg->chnum, base + EDMA3_QEECR);
 | |
| 
 | |
| 	/* clean up the interrupt indication */
 | |
| 	if (cfg->complete_code < 32)
 | |
| 		__raw_writel(1 << cfg->complete_code, base + EDMA3_ICR);
 | |
| 	else
 | |
| 		__raw_writel(1 << cfg->complete_code, base + EDMA3_ICRH);
 | |
| 
 | |
| 	/* Clear missed event if set*/
 | |
| 	__raw_writel(1 << cfg->chnum, base + EDMA3_QSECR);
 | |
| 	__raw_writel(1 << cfg->chnum, base + EDMA3_QEMCR);
 | |
| 
 | |
| 	/* Clear the channel map */
 | |
| 	__raw_writel(0, base + EDMA3_QCHMAP(cfg->chnum));
 | |
| }
 | |
| 
 | |
| void __edma3_transfer(unsigned long edma3_base_addr, unsigned int edma_slot_num,
 | |
| 		      void *dst, void *src, size_t len, size_t s_len)
 | |
| {
 | |
| 	struct edma3_slot_config        slot;
 | |
| 	struct edma3_channel_config     edma_channel;
 | |
| 	int                             b_cnt_value = 1;
 | |
| 	int                             rem_bytes  = 0;
 | |
| 	int                             a_cnt_value = len;
 | |
| 	unsigned int                    addr = (unsigned int) (dst);
 | |
| 	unsigned int                    max_acnt  = 0x7FFFU;
 | |
| 
 | |
| 	if (len > s_len) {
 | |
| 		b_cnt_value = (len / s_len);
 | |
| 		rem_bytes = (len % s_len);
 | |
| 		a_cnt_value = s_len;
 | |
| 	} else if (len > max_acnt) {
 | |
| 		b_cnt_value = (len / max_acnt);
 | |
| 		rem_bytes  = (len % max_acnt);
 | |
| 		a_cnt_value = max_acnt;
 | |
| 	}
 | |
| 
 | |
| 	slot.opt        = 0;
 | |
| 	slot.src        = ((unsigned int) src);
 | |
| 	slot.acnt       = a_cnt_value;
 | |
| 	slot.bcnt       = b_cnt_value;
 | |
| 	slot.ccnt       = 1;
 | |
| 	if (len == s_len)
 | |
| 		slot.src_bidx = a_cnt_value;
 | |
| 	else
 | |
| 		slot.src_bidx = 0;
 | |
| 	slot.dst_bidx   = a_cnt_value;
 | |
| 	slot.src_cidx   = 0;
 | |
| 	slot.dst_cidx   = 0;
 | |
| 	slot.link       = EDMA3_PARSET_NULL_LINK;
 | |
| 	slot.bcntrld    = 0;
 | |
| 	slot.opt        = EDMA3_SLOPT_TRANS_COMP_INT_ENB |
 | |
| 			  EDMA3_SLOPT_COMP_CODE(0) |
 | |
| 			  EDMA3_SLOPT_STATIC | EDMA3_SLOPT_AB_SYNC;
 | |
| 
 | |
| 	edma3_slot_configure(edma3_base_addr, edma_slot_num, &slot);
 | |
| 	edma_channel.slot = edma_slot_num;
 | |
| 	edma_channel.chnum = 0;
 | |
| 	edma_channel.complete_code = 0;
 | |
| 	 /* set event trigger to dst update */
 | |
| 	edma_channel.trigger_slot_word = EDMA3_TWORD(dst);
 | |
| 
 | |
| 	qedma3_start(edma3_base_addr, &edma_channel);
 | |
| 	edma3_set_dest_addr(edma3_base_addr, edma_channel.slot, addr);
 | |
| 
 | |
| 	while (edma3_check_for_transfer(edma3_base_addr, &edma_channel))
 | |
| 		;
 | |
| 	qedma3_stop(edma3_base_addr, &edma_channel);
 | |
| 
 | |
| 	if (rem_bytes != 0) {
 | |
| 		slot.opt        = 0;
 | |
| 		if (len == s_len)
 | |
| 			slot.src =
 | |
| 				(b_cnt_value * max_acnt) + ((unsigned int) src);
 | |
| 		else
 | |
| 			slot.src = (unsigned int) src;
 | |
| 		slot.acnt       = rem_bytes;
 | |
| 		slot.bcnt       = 1;
 | |
| 		slot.ccnt       = 1;
 | |
| 		slot.src_bidx   = rem_bytes;
 | |
| 		slot.dst_bidx   = rem_bytes;
 | |
| 		slot.src_cidx   = 0;
 | |
| 		slot.dst_cidx   = 0;
 | |
| 		slot.link       = EDMA3_PARSET_NULL_LINK;
 | |
| 		slot.bcntrld    = 0;
 | |
| 		slot.opt        = EDMA3_SLOPT_TRANS_COMP_INT_ENB |
 | |
| 				  EDMA3_SLOPT_COMP_CODE(0) |
 | |
| 				  EDMA3_SLOPT_STATIC | EDMA3_SLOPT_AB_SYNC;
 | |
| 		edma3_slot_configure(edma3_base_addr, edma_slot_num, &slot);
 | |
| 		edma_channel.slot = edma_slot_num;
 | |
| 		edma_channel.chnum = 0;
 | |
| 		edma_channel.complete_code = 0;
 | |
| 		/* set event trigger to dst update */
 | |
| 		edma_channel.trigger_slot_word = EDMA3_TWORD(dst);
 | |
| 
 | |
| 		qedma3_start(edma3_base_addr, &edma_channel);
 | |
| 		edma3_set_dest_addr(edma3_base_addr, edma_channel.slot, addr +
 | |
| 				    (max_acnt * b_cnt_value));
 | |
| 		while (edma3_check_for_transfer(edma3_base_addr, &edma_channel))
 | |
| 			;
 | |
| 		qedma3_stop(edma3_base_addr, &edma_channel);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| void __edma3_fill(unsigned long edma3_base_addr, unsigned int edma_slot_num,
 | |
| 		  void *dst, u8 val, size_t len)
 | |
| {
 | |
| 	int xfer_len;
 | |
| 	int max_xfer = EDMA_FILL_BUFFER_SIZE * 65535;
 | |
| 
 | |
| 	memset((void *)edma_fill_buffer, val, sizeof(edma_fill_buffer));
 | |
| 
 | |
| 	while (len) {
 | |
| 		xfer_len = len;
 | |
| 		if (xfer_len > max_xfer)
 | |
| 			xfer_len = max_xfer;
 | |
| 
 | |
| 		__edma3_transfer(edma3_base_addr, edma_slot_num, dst,
 | |
| 				 edma_fill_buffer, xfer_len,
 | |
| 				 EDMA_FILL_BUFFER_SIZE);
 | |
| 		len -= xfer_len;
 | |
| 		dst += xfer_len;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| #ifndef CONFIG_DMA
 | |
| 
 | |
| void edma3_transfer(unsigned long edma3_base_addr, unsigned int edma_slot_num,
 | |
| 		    void *dst, void *src, size_t len)
 | |
| {
 | |
| 	__edma3_transfer(edma3_base_addr, edma_slot_num, dst, src, len, len);
 | |
| }
 | |
| 
 | |
| void edma3_fill(unsigned long edma3_base_addr, unsigned int edma_slot_num,
 | |
| 		void *dst, u8 val, size_t len)
 | |
| {
 | |
| 	__edma3_fill(edma3_base_addr, edma_slot_num, dst, val, len);
 | |
| }
 | |
| 
 | |
| #else
 | |
| 
 | |
| static int ti_edma3_transfer(struct udevice *dev, int direction, void *dst,
 | |
| 			     void *src, size_t len)
 | |
| {
 | |
| 	struct ti_edma3_priv *priv = dev_get_priv(dev);
 | |
| 
 | |
| 	/* enable edma3 clocks */
 | |
| 	enable_edma3_clocks();
 | |
| 
 | |
| 	switch (direction) {
 | |
| 	case DMA_MEM_TO_MEM:
 | |
| 		__edma3_transfer(priv->base, 1, dst, src, len, len);
 | |
| 		break;
 | |
| 	default:
 | |
| 		pr_err("Transfer type not implemented in DMA driver\n");
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	/* disable edma3 clocks */
 | |
| 	disable_edma3_clocks();
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int ti_edma3_ofdata_to_platdata(struct udevice *dev)
 | |
| {
 | |
| 	struct ti_edma3_priv *priv = dev_get_priv(dev);
 | |
| 
 | |
| 	priv->base = devfdt_get_addr(dev);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int ti_edma3_probe(struct udevice *dev)
 | |
| {
 | |
| 	struct dma_dev_priv *uc_priv = dev_get_uclass_priv(dev);
 | |
| 
 | |
| 	uc_priv->supported = DMA_SUPPORTS_MEM_TO_MEM;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct dma_ops ti_edma3_ops = {
 | |
| 	.transfer	= ti_edma3_transfer,
 | |
| };
 | |
| 
 | |
| static const struct udevice_id ti_edma3_ids[] = {
 | |
| 	{ .compatible = "ti,edma3" },
 | |
| 	{ }
 | |
| };
 | |
| 
 | |
| U_BOOT_DRIVER(ti_edma3) = {
 | |
| 	.name	= "ti_edma3",
 | |
| 	.id	= UCLASS_DMA,
 | |
| 	.of_match = ti_edma3_ids,
 | |
| 	.ops	= &ti_edma3_ops,
 | |
| 	.ofdata_to_platdata = ti_edma3_ofdata_to_platdata,
 | |
| 	.probe	= ti_edma3_probe,
 | |
| 	.priv_auto_alloc_size = sizeof(struct ti_edma3_priv),
 | |
| };
 | |
| #endif /* CONFIG_DMA */
 |