/* * Copyright (C) 2013-2015 Allwinnertech Co., Ltd * Author: zqb * * Sunxi DMA controller driver * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include "virt-dma.h" /****************Patch for DMA Bug********************************* * If we use a pchan for cyclic last time,we can't use it for memcpy * until another pchan end, So before we fix the bug,we can avoid it * Here is ways to avoid */ /*way1:cyclic and no cyclic use different pchan*/ #define CYC_MEM_DIFF /*way2:forbid the memcpy use this kind of pchan*/ /*#define MEM_NOT_FOLLOW_CYC*/ /*way3:assign the pchan by pchan_assign*/ /*#define ASSIGN_PCHAN*/ /*way4:wait the dma end before terminate*/ /*#define TERMINATE_WAIT_DMA*/ #define SUN3I_PCHAN_INNER_BUFFER_LEN 1024 #define SUN3I_DMA_DRQ_TYPE_NONE 0x1F #define SUN3I_DMA_VCHAN_IS_DEDICATED 0x01 #define SUN3I_DMA_VCHAN_IS_NOT_DEDICATED 0x00 /** Common macros to normal and dedicated DMA registers **/ #define SUN3I_DMA_CFG_LOADING BIT(31) #define SUN3I_DMA_CFG_DST_DATA_WIDTH(width) ((width) << 24) #define SUN3I_DMA_CFG_DST_BURST_LENGTH(len) ((len) << 23) #define SUN3I_DMA_CFG_DST_ADDR_MODE(mode) ((mode) << 21) #define SUN3I_DMA_CFG_DST_DRQ_TYPE(type) ((type) << 16) #define SUN3I_DMA_CFG_SRC_DATA_WIDTH(width) ((width) << 8) #define SUN3I_DMA_CFG_SRC_BURST_LENGTH(len) ((len) << 7) #define SUN3I_DMA_CFG_SRC_ADDR_MODE(mode) ((mode) << 5) #define SUN3I_DMA_CFG_SRC_DRQ_TYPE(type) (type) /** Normal DMA register values **/ /* Normal DMA source/destination data request type values */ #define SUN3I_NDMA_DRQ_TYPE_SDRAM 0x11 #define SUN3I_NDMA_DRQ_TYPE_LIMIT (0x1F + 1) #define SUN3I_DRQ_TYPE_LIMIT 0x18 #define SUN3I_NDMA_SDRAM2SDRAM_CFG 0x82118211 #define SUN3I_DDMA_SDRAM2SDRAM_CFG 0x82018201 /** Normal DMA register layout **/ /* Dedicated DMA source/destination address mode values */ #define SUN3I_NDMA_ADDR_MODE_LINEAR 0 #define SUN3I_NDMA_ADDR_MODE_IO 1 /* Normal DMA configuration register layout */ #define SUN3I_NDMA_CFG_CONT_MODE BIT(29) #define SUN3I_NDMA_CFG_WAIT_STATE(n) ((n) << 26) #define SUN3I_NDMA_CFG_BYTE_COUNT_MODE_REMAIN BIT(15) /** Dedicated DMA register values **/ /* Dedicated DMA source/destination address mode values */ #define SUN3I_DDMA_ADDR_MODE_LINEAR 0 #define SUN3I_DDMA_ADDR_MODE_IO 1 /* Dedicated DMA source/destination data request type values */ #define SUN3I_DDMA_DRQ_TYPE_SDRAM (0x1) #define SUN3I_DDMA_DRQ_TYPE_LIMIT (0x1F + 1) /** Dedicated DMA register layout **/ /* Dedicated DMA configuration register layout */ #define SUN3I_DDMA_CFG_BUSY BIT(30) #define SUN3I_DDMA_CFG_CONT_MODE BIT(29) #define SUN3I_DDMA_CFG_DST_NON_SECURE BIT(28) #define SUN3I_DDMA_CFG_BYTE_COUNT_MODE_REMAIN BIT(15) /* Dedicated DMA parameter register layout */ #define SUN3I_DDMA_PARA_DST_DATA_BLK_SIZE(n) (((n) - 1) << 24) #define SUN3I_DDMA_PARA_DST_WAIT_CYCLES(n) (((n) - 1) << 16) #define SUN3I_DDMA_PARA_SRC_DATA_BLK_SIZE(n) (((n) - 1) << 8) #define SUN3I_DDMA_PARA_SRC_WAIT_CYCLES(n) (((n) - 1) << 0) /** DMA register offsets **/ /* General register offsets */ #define SUN3I_DMA_IRQ_ENABLE_REG 0x0 #define SUN3I_DMA_IRQ_PENDING_STATUS_REG 0x4 /* Normal DMA register offsets */ #define SUN3I_NDMA_CHANNEL_REG_BASE(n) (0x100 + (n) * 0x20) #define SUN3I_NDMA_CFG_REG 0x0 #define SUN3I_NDMA_SRC_ADDR_REG 0x4 #define SUN3I_NDMA_DST_ADDR_REG 0x8 #define SUN3I_NDMA_BYTE_COUNT_REG 0xC /* Dedicated DMA register offsets */ #define SUN3I_DDMA_CHANNEL_REG_BASE(n) (0x300 + (n) * 0x20) #define SUN3I_DDMA_CFG_REG 0x0 #define SUN3I_DDMA_SRC_ADDR_REG 0x4 #define SUN3I_DDMA_DST_ADDR_REG 0x8 #define SUN3I_DDMA_BYTE_COUNT_REG 0xC #define SUN3I_DDMA_PARA_REG 0x18 #define SUN3I_DDMA_GEN_DATA 0x1C /** DMA Driver **/ /* * Normal DMA has 8 channels, and Dedicated DMA has another 8, so * that's 16 channels. As for endpoints, there's 29 and 21 * respectively. Given that the Normal DMA endpoints (other than * SDRAM) can be used as tx/rx, we need 78 vchans in total */ #define SUN3I_NDMA_NR_MAX_CHANNELS 4 #define SUN3I_DDMA_NR_MAX_CHANNELS 4 #define SUN3I_DMA_NR_MAX_CHANNELS \ (SUN3I_NDMA_NR_MAX_CHANNELS + SUN3I_DDMA_NR_MAX_CHANNELS) #define SUN3I_NDMA_NR_MAX_VCHANS (29 * 2 - 1) #define SUN3I_DDMA_NR_MAX_VCHANS 21 #define SUN3I_DMA_NR_MAX_VCHANS \ (SUN3I_NDMA_NR_MAX_VCHANS + SUN3I_DDMA_NR_MAX_VCHANS) /* This set of SUN3I_DDMA timing parameters were found experimentally while * working with the SPI driver and seem to make it behave correctly */ #define SUN3I_DDMA_MAGIC_SPI_PARAMETERS \ (SUN3I_DDMA_PARA_DST_DATA_BLK_SIZE(1) | \ SUN3I_DDMA_PARA_SRC_DATA_BLK_SIZE(1) | \ SUN3I_DDMA_PARA_DST_WAIT_CYCLES(2) | \ SUN3I_DDMA_PARA_SRC_WAIT_CYCLES(2)) struct sun3i_dma_pchan { /* Register base of channel */ void __iomem *base; /* vchan currently being serviced */ struct sun3i_dma_vchan *vchan; /* Is this a dedicated pchan? */ int is_dedicated; char *inner_buf_src; char *inner_buf_dst; dma_addr_t inner_dma_src; dma_addr_t inner_dma_dst; }; struct sun3i_dma_vchan { struct virt_dma_chan vc; struct dma_slave_config cfg; struct sun3i_dma_pchan *pchan; struct sun3i_dma_promise *processing; struct sun3i_dma_contract *contract; u8 endpoint; int is_dedicated; int terminating; }; struct sun3i_dma_promise { u32 cfg; u32 para; dma_addr_t src; dma_addr_t dst; size_t len; struct list_head list; }; /* A contract is a set of promises */ struct sun3i_dma_contract { struct virt_dma_desc vd; struct list_head demands; struct list_head completed_demands; int is_cyclic; }; struct sun3i_dma_dev { DECLARE_BITMAP(pchans_used, SUN3I_DMA_NR_MAX_CHANNELS); DECLARE_BITMAP(pchans_cyclic, SUN3I_DMA_NR_MAX_CHANNELS); struct dma_device slave; struct sun3i_dma_pchan *pchans; struct sun3i_dma_vchan *vchans; void __iomem *base; struct clk *clk; int irq; spinlock_t lock; }; static struct sun3i_dma_dev *to_sun3i_dma_dev(struct dma_device *dev) { return container_of(dev, struct sun3i_dma_dev, slave); } static struct sun3i_dma_vchan *to_sun3i_dma_vchan(struct dma_chan *chan) { return container_of(chan, struct sun3i_dma_vchan, vc.chan); } static struct sun3i_dma_contract *to_sun3i_dma_contract(struct virt_dma_desc *vd) { return container_of(vd, struct sun3i_dma_contract, vd); } static struct device *chan2dev(struct dma_chan *chan) { return &chan->dev->device; } static int convert_burst(u32 maxburst) { if (maxburst > 8) return -EINVAL; /* sun3i only support burst 1 or 4 */ if (maxburst > 4) maxburst = 1; /* 1 -> 0, 4 -> 1 */ return maxburst >> 2; } static int convert_buswidth(enum dma_slave_buswidth addr_width) { if (addr_width > DMA_SLAVE_BUSWIDTH_4_BYTES) return -EINVAL; /* 8 (1 byte) -> 0, 16 (2 bytes) -> 1, 32 (4 bytes) -> 2 */ return addr_width >> 1; } static int sun3i_dma_alloc_chan_resources(struct dma_chan *chan) { return 0; } static void sun3i_dma_free_chan_resources(struct dma_chan *chan) { struct sun3i_dma_vchan *vchan = to_sun3i_dma_vchan(chan); vchan_free_chan_resources(&vchan->vc); return; } static struct sun3i_dma_pchan * find_and_use_pchan(struct sun3i_dma_dev *priv, struct sun3i_dma_vchan *vchan, int type) { struct sun3i_dma_pchan *pchan = NULL, *pchans = priv->pchans; unsigned long flags; int i, max; u8 chan_allow = 0xFF; /* F1xx means only allow pchan mark by xx */ if ((type >> 8) == 0xF1) chan_allow &= (type & 0xFF); /* F2xx means don't allow pchan mark by xx */ else if ((type >> 8) == 0xF2) chan_allow &= ~(type & 0xFF); /* * pchans 0-SUN3I_NDMA_NR_MAX_CHANNELS are normal, and * SUN3I_NDMA_NR_MAX_CHANNELS+ are dedicated ones */ if (vchan->is_dedicated) { i = SUN3I_NDMA_NR_MAX_CHANNELS; max = SUN3I_DMA_NR_MAX_CHANNELS; } else { i = 0; max = SUN3I_NDMA_NR_MAX_CHANNELS; } spin_lock_irqsave(&priv->lock, flags); for_each_clear_bit_from(i, priv->pchans_used, max) { /* type 1 means do not use the pchan cyclic last time */ if (type == 1 && test_bit(i, priv->pchans_cyclic)) continue; if (!(chan_allow & (1 << i))) continue; pchan = &pchans[i]; pchan->vchan = vchan; set_bit(i, priv->pchans_used); break; } spin_unlock_irqrestore(&priv->lock, flags); return pchan; } static void release_vchan(struct sun3i_dma_vchan *vchan) { lockdep_assert_held(&vchan->vc.lock); /* Clear these so the vchan is usable again */ vchan->processing = NULL; vchan->pchan = NULL; vchan->endpoint = SUN3I_DMA_DRQ_TYPE_NONE; vchan->is_dedicated = SUN3I_DMA_VCHAN_IS_NOT_DEDICATED; return; } static void release_pchan_cyclic(struct sun3i_dma_dev *priv, struct sun3i_dma_pchan *pchan) { unsigned long flags; int nr = pchan - priv->pchans; int i = 0; spin_lock_irqsave(&priv->lock, flags); /* if this pchan is not cyclic this time,clear the cyclic flag */ if (!test_bit(nr, priv->pchans_cyclic)) { i = 0; for_each_set_bit_from(i, priv->pchans_cyclic, 4) { if (!test_bit(i, priv->pchans_used)) clear_bit(i, priv->pchans_cyclic); } } spin_unlock_irqrestore(&priv->lock, flags); return; } static void release_pchan(struct sun3i_dma_dev *priv, struct sun3i_dma_pchan *pchan) { unsigned long flags; int nr = pchan - priv->pchans; spin_lock_irqsave(&priv->lock, flags); pchan->vchan = NULL; clear_bit(nr, priv->pchans_used); spin_unlock_irqrestore(&priv->lock, flags); } static void configure_pchan(struct sun3i_dma_pchan *pchan, struct sun3i_dma_promise *d) { /* * Configure addresses and misc parameters depending on type * sun3i_DDMA has an extra field with timing parameters */ if (pchan->is_dedicated) { writel_relaxed(d->src, pchan->base + SUN3I_DDMA_SRC_ADDR_REG); writel_relaxed(d->dst, pchan->base + SUN3I_DDMA_DST_ADDR_REG); writel_relaxed(d->len, pchan->base + SUN3I_DDMA_BYTE_COUNT_REG); writel_relaxed(d->para, pchan->base + SUN3I_DDMA_PARA_REG); writel_relaxed(d->cfg, pchan->base + SUN3I_DDMA_CFG_REG); } else { writel_relaxed(d->src, pchan->base + SUN3I_NDMA_SRC_ADDR_REG); writel_relaxed(d->dst, pchan->base + SUN3I_NDMA_DST_ADDR_REG); writel_relaxed(d->len, pchan->base + SUN3I_NDMA_BYTE_COUNT_REG); writel_relaxed(d->cfg, pchan->base + SUN3I_NDMA_CFG_REG); } } static void set_pchan_interrupt(struct sun3i_dma_dev *priv, struct sun3i_dma_pchan *pchan, int half, int end) { u32 reg; int pchan_number = pchan - priv->pchans; unsigned long flags; spin_lock_irqsave(&priv->lock, flags); reg = readl_relaxed(priv->base + SUN3I_DMA_IRQ_ENABLE_REG); if (half) reg |= BIT(pchan_number * 2); else reg &= ~BIT(pchan_number * 2); if (end) reg |= BIT(pchan_number * 2 + 1); else reg &= ~BIT(pchan_number * 2 + 1); writel_relaxed(reg, priv->base + SUN3I_DMA_IRQ_ENABLE_REG); spin_unlock_irqrestore(&priv->lock, flags); } #define PCHAN_ASSIGN_NDMA_SRC(drq_type) (drq_type|(0x11<<8)) #define PCHAN_ASSIGN_NDMA_DST(drq_type) (drq_type|(0x12<<8)) #define PCHAN_ASSIGN_DDMA_SRC(drq_type) (drq_type|(0x21<<8)) #define PCHAN_ASSIGN_DDMA_DST(drq_type) (drq_type|(0x22<<8)) #define PCHAN_FROM(pchan_ok) \ (0xF100 | (pchan_ok)) #define PCHAN_NOT_FROM(pchan_not_ok) \ (0xF200 | (pchan_not_ok)) #define PCHAN_FROM2NOT_FROM(pchan_from) \ PCHAN_NOT_FROM(~((pchan_from)&0xFF)) #define PCHAN_NOT_FROM2FROM(pchan_not_from) \ PCHAN_FROM(~((pchan_not_from)&0xFF)) #define PCHAN_ONLY(pchan) \ PCHAN_FROM(1<> 8 == 0xF1) type = old_type; else if (old_type >> 8 == 0xF2) type = PCHAN_NOT_FROM2FROM(old_type); else type = old_type; } return type; } #if defined(ASSIGN_PCHAN) static u32 generate_type_by_promise(struct sun3i_dma_vchan *vchan, int old_type) { struct sun3i_dma_promise *promise = NULL; struct sun3i_dma_contract *contract = NULL; struct sun3i_dma_pchan *pchan; struct virt_dma_desc *vd; int i, type; int src_drq, dst_drq; type = sanitize_type(old_type); if (vchan->processing) return type; vd = vchan_next_desc(&vchan->vc); if (!vd) return type; contract = to_sun3i_dma_contract(vd); promise = list_first_entry(&contract->demands, struct sun3i_dma_promise, list); if (!promise) return type; src_drq = (promise->cfg) & 0x1F; dst_drq = (promise->cfg >> 16) & 0x1F; if (vchan->is_dedicated) { src_drq = PCHAN_ASSIGN_DDMA_SRC(src_drq); dst_drq = PCHAN_ASSIGN_DDMA_DST(dst_drq); } else { src_drq = PCHAN_ASSIGN_NDMA_SRC(src_drq); dst_drq = PCHAN_ASSIGN_NDMA_DST(dst_drq); } for (i = 0; i < sizeof(pchan_assign) / sizeof(int[2]); i++) { if ((pchan_assign[i][0] == src_drq) || (pchan_assign[i][0] == dst_drq)) { type = pchan_assign[i][1]; break; } } return type; } #endif #if defined(CYC_MEM_DIFF) #define PCHAN_FOR_CYC 0xCC #define PCHAN_FOR_NOT_CYC 0x33 static u32 generate_type_by_contract(struct sun3i_dma_vchan *vchan, int old_type) { struct sun3i_dma_contract *contract = NULL; struct virt_dma_desc *vd; int type; type = sanitize_type(old_type); if (vchan->processing) return type; vd = vchan_next_desc(&vchan->vc); if (!vd) return type; contract = to_sun3i_dma_contract(vd); if (contract->is_cyclic) type = PCHAN_FROM(type & 0xFF & PCHAN_FOR_CYC); else type = PCHAN_FROM(type & 0xFF & PCHAN_FOR_NOT_CYC); return type; } #endif #if defined(MEM_NOT_FOLLOW_CYC) static u32 generate_type_mem_not_follow_cyc(struct sun3i_dma_vchan *vchan, int old_type) { struct sun3i_dma_promise *promise = NULL; struct sun3i_dma_contract *contract = NULL; struct virt_dma_desc *vd; int i, type; int src_drq, dst_drq; type = sanitize_type(old_type); if (vchan->processing) return type; vd = vchan_next_desc(&vchan->vc); if (!vd) return type; contract = to_sun3i_dma_contract(vd); if (contract->is_cyclic) type = 0; else type = 1; return type; } #endif /** * Execute pending operations on a vchan * * When given a vchan, this function will try to acquire a suitable * pchan and, if successful, will configure it to fulfill a promise * from the next pending contract. * * This function must be called with &vchan->vc.lock held. */ static int __execute_vchan_pending(struct sun3i_dma_dev *priv, struct sun3i_dma_vchan *vchan) { struct sun3i_dma_promise *promise = NULL; struct sun3i_dma_contract *contract = NULL; struct sun3i_dma_pchan *pchan; struct virt_dma_desc *vd; int ret; int type = 0; lockdep_assert_held(&vchan->vc.lock); #if defined(ASSIGN_PCHAN) type = generate_type_by_promise(vchan, type); #endif #if defined(CYC_MEM_DIFF) type = generate_type_by_contract(vchan, type); #endif #if defined(MEM_NOT_FOLLOW_CYC) type = generate_type_mem_not_follow_cyc(vchan, type); #endif /* We need a pchan to do anything, so secure one if available */ pchan = find_and_use_pchan(priv, vchan, type); if (!pchan) return -EBUSY; /* * Channel endpoints must not be repeated, so if this vchan * has already submitted some work, we can't do anything else */ if (vchan->processing) { dev_dbg(chan2dev(&vchan->vc.chan), "processing something to this endpoint already\n"); ret = -EBUSY; goto release_pchan; } do { /* Figure out which contract we're working with today */ vd = vchan_next_desc(&vchan->vc); if (!vd) { dev_dbg(chan2dev(&vchan->vc.chan), "No pending contract found"); ret = 0; goto release_pchan; } contract = to_sun3i_dma_contract(vd); if (list_empty(&contract->demands)) { /* The contract has been completed so mark it as such */ list_del(&contract->vd.node); vchan_cookie_complete(&contract->vd); dev_dbg(chan2dev(&vchan->vc.chan), "Empty contract found and marked complete"); } } while (list_empty(&contract->demands)); /* Now find out what we need to do */ promise = list_first_entry(&contract->demands, struct sun3i_dma_promise, list); vchan->processing = promise; /* ... and make it reality */ if (promise) { vchan->contract = contract; vchan->pchan = pchan; set_pchan_interrupt(priv, pchan, contract->is_cyclic, 1); configure_pchan(pchan, promise); } return 0; release_pchan: release_pchan(priv, pchan); return ret; } static int sanitize_config(struct dma_slave_config *sconfig, enum dma_transfer_direction direction) { switch (direction) { case DMA_MEM_TO_DEV: if ((sconfig->dst_addr_width == DMA_SLAVE_BUSWIDTH_UNDEFINED) || !sconfig->dst_maxburst) return -EINVAL; if (sconfig->src_addr_width == DMA_SLAVE_BUSWIDTH_UNDEFINED) sconfig->src_addr_width = sconfig->dst_addr_width; if (!sconfig->src_maxburst) sconfig->src_maxburst = sconfig->dst_maxburst; break; case DMA_DEV_TO_MEM: if ((sconfig->src_addr_width == DMA_SLAVE_BUSWIDTH_UNDEFINED) || !sconfig->src_maxburst) return -EINVAL; if (sconfig->dst_addr_width == DMA_SLAVE_BUSWIDTH_UNDEFINED) sconfig->dst_addr_width = sconfig->src_addr_width; if (!sconfig->dst_maxburst) sconfig->dst_maxburst = sconfig->src_maxburst; break; default: return 0; } return 0; } static int sanitize_vchan(struct sun3i_dma_vchan *vchan) { u8 src_ep, dst_ep; /*sanitize endpoint */ if (vchan->endpoint == 0 || vchan->endpoint > SUN3I_DRQ_TYPE_LIMIT) { /* * The old driver of sun3i use endpoint config in device tree, * but the other sunxi driver will config endpoint by slave_id. * To support both way, we check endpoint first, if invalid, * try to get endpoint from slave_id. * * we support both way now, but finally we will let all driver * of sun3i use the slave_id interface, then remove these code, * not support config endpoint in dtb anymore. */ src_ep = GET_SRC_DRQ(vchan->cfg.slave_id); dst_ep = GET_DST_DRQ(vchan->cfg.slave_id) >> 16; if (src_ep != 0 && src_ep != SUN3I_NDMA_DRQ_TYPE_SDRAM) vchan->endpoint = src_ep; else if (dst_ep != 0 && dst_ep != SUN3I_NDMA_DRQ_TYPE_SDRAM) vchan->endpoint = dst_ep; else vchan->endpoint = SUN3I_NDMA_DRQ_TYPE_SDRAM; } return 0; } /** * Generate a promise, to be used in a normal DMA contract. * * A NDMA promise contains all the information required to program the * normal part of the DMA Engine and get data copied. A non-executed * promise will live in the demands list on a contract. Once it has been * completed, it will be moved to the completed demands list for later freeing. * All linked promises will be freed when the corresponding contract is freed */ static struct sun3i_dma_promise * generate_ndma_promise(struct dma_chan *chan, dma_addr_t src, dma_addr_t dest, size_t len, struct dma_slave_config *sconfig, enum dma_transfer_direction direction) { struct sun3i_dma_promise *promise; int ret; ret = sanitize_config(sconfig, direction); if (ret) return NULL; promise = kzalloc(sizeof(*promise), GFP_NOWAIT); if (!promise) return NULL; promise->src = src; promise->dst = dest; promise->len = len; promise->cfg = SUN3I_DMA_CFG_LOADING | SUN3I_NDMA_CFG_BYTE_COUNT_MODE_REMAIN; dev_dbg(chan2dev(chan), "src burst %d, dst burst %d, src buswidth %d, dst buswidth %d", sconfig->src_maxburst, sconfig->dst_maxburst, sconfig->src_addr_width, sconfig->dst_addr_width); /* Source burst */ ret = convert_burst(sconfig->src_maxburst); if (IS_ERR_VALUE(ret)) goto fail; promise->cfg |= SUN3I_DMA_CFG_SRC_BURST_LENGTH(ret); /* Destination burst */ ret = convert_burst(sconfig->dst_maxburst); if (IS_ERR_VALUE(ret)) goto fail; promise->cfg |= SUN3I_DMA_CFG_DST_BURST_LENGTH(ret); /* Source bus width */ ret = convert_buswidth(sconfig->src_addr_width); if (IS_ERR_VALUE(ret)) goto fail; promise->cfg |= SUN3I_DMA_CFG_SRC_DATA_WIDTH(ret); /* Destination bus width */ ret = convert_buswidth(sconfig->dst_addr_width); if (IS_ERR_VALUE(ret)) goto fail; promise->cfg |= SUN3I_DMA_CFG_DST_DATA_WIDTH(ret); return promise; fail: kfree(promise); return NULL; } /** * Generate a promise, to be used in a dedicated DMA contract. * * A DDMA promise contains all the information required to program the * Dedicated part of the DMA Engine and get data copied. A non-executed * promise will live in the demands list on a contract. Once it has been * completed, it will be moved to the completed demands list for later freeing. * All linked promises will be freed when the corresponding contract is freed */ static struct sun3i_dma_promise * generate_ddma_promise(struct dma_chan *chan, dma_addr_t src, dma_addr_t dest, size_t len, struct dma_slave_config *sconfig) { struct sun3i_dma_promise *promise; int ret; promise = kzalloc(sizeof(*promise), GFP_NOWAIT); if (!promise) return NULL; promise->src = src; promise->dst = dest; promise->len = len; promise->cfg = SUN3I_DMA_CFG_LOADING | SUN3I_DDMA_CFG_BYTE_COUNT_MODE_REMAIN; /* Source burst */ ret = convert_burst(sconfig->src_maxburst); if (IS_ERR_VALUE(ret)) goto fail; promise->cfg |= SUN3I_DMA_CFG_SRC_BURST_LENGTH(ret); /* Destination burst */ ret = convert_burst(sconfig->dst_maxburst); if (IS_ERR_VALUE(ret)) goto fail; promise->cfg |= SUN3I_DMA_CFG_DST_BURST_LENGTH(ret); /* Source bus width */ ret = convert_buswidth(sconfig->src_addr_width); if (IS_ERR_VALUE(ret)) goto fail; promise->cfg |= SUN3I_DMA_CFG_SRC_DATA_WIDTH(ret); /* Destination bus width */ ret = convert_buswidth(sconfig->dst_addr_width); if (IS_ERR_VALUE(ret)) goto fail; promise->cfg |= SUN3I_DMA_CFG_DST_DATA_WIDTH(ret); return promise; fail: kfree(promise); return NULL; } /** * Generate a contract * * Contracts function as DMA descriptors. As our hardware does not support * linked lists, we need to implement SG via software. We use a contract * to hold all the pieces of the request and process them serially one * after another. Each piece is represented as a promise. */ static struct sun3i_dma_contract *generate_dma_contract(void) { struct sun3i_dma_contract *contract; contract = kzalloc(sizeof(*contract), GFP_NOWAIT); if (!contract) return NULL; INIT_LIST_HEAD(&contract->demands); INIT_LIST_HEAD(&contract->completed_demands); return contract; } /** * Get next promise on a cyclic transfer * * Cyclic contracts contain a series of promises which are executed on a * loop. This function returns the next promise from a cyclic contract, * so it can be programmed into the hardware. */ static struct sun3i_dma_promise *get_next_cyclic_promise(struct sun3i_dma_contract *contract) { struct sun3i_dma_promise *promise; promise = list_first_entry_or_null(&contract->demands, struct sun3i_dma_promise, list); if (!promise) { list_splice_init(&contract->completed_demands, &contract->demands); promise = list_first_entry(&contract->demands, struct sun3i_dma_promise, list); } return promise; } /** * Free a contract and all its associated promises */ static void sun3i_dma_free_contract(struct virt_dma_desc *vd) { struct sun3i_dma_contract *contract = to_sun3i_dma_contract(vd); struct sun3i_dma_promise *promise, *tmp; /* Free all the demands and completed demands */ list_for_each_entry_safe(promise, tmp, &contract->demands, list) kfree(promise); list_for_each_entry_safe(promise, tmp, &contract->completed_demands, list) kfree(promise); kfree(contract); } static struct dma_async_tx_descriptor * sun3i_dma_prep_dma_memcpy(struct dma_chan *chan, dma_addr_t dest, dma_addr_t src, size_t len, unsigned long flags) { struct sun3i_dma_vchan *vchan = to_sun3i_dma_vchan(chan); struct dma_slave_config *sconfig = &vchan->cfg; struct sun3i_dma_promise *promise; struct sun3i_dma_contract *contract; sanitize_vchan(vchan); contract = generate_dma_contract(); if (!contract) return NULL; /* * We can only do the copy to bus aligned addresses, so * choose the best one so we get decent performance. We also * maximize the burst size for this same reason. */ sconfig->src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; sconfig->dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; sconfig->src_maxburst = 4; sconfig->dst_maxburst = 4; if (vchan->is_dedicated) promise = generate_ddma_promise(chan, src, dest, len, sconfig); else promise = generate_ndma_promise(chan, src, dest, len, sconfig, DMA_MEM_TO_MEM); if (!promise) { kfree(contract); return NULL; } /* Configure memcpy mode */ if (vchan->is_dedicated) { promise->cfg |= SUN3I_DMA_CFG_SRC_DRQ_TYPE(SUN3I_DDMA_DRQ_TYPE_SDRAM) | SUN3I_DMA_CFG_DST_DRQ_TYPE(SUN3I_DDMA_DRQ_TYPE_SDRAM); } else { promise->cfg |= SUN3I_DMA_CFG_SRC_DRQ_TYPE(SUN3I_NDMA_DRQ_TYPE_SDRAM) | SUN3I_DMA_CFG_DST_DRQ_TYPE(SUN3I_NDMA_DRQ_TYPE_SDRAM); } /* Fill the contract with our only promise */ list_add_tail(&promise->list, &contract->demands); /* And add it to the vchan */ return vchan_tx_prep(&vchan->vc, &contract->vd, flags); } static struct dma_async_tx_descriptor * sun3i_dma_prep_dma_cyclic(struct dma_chan *chan, dma_addr_t buf, size_t len, size_t period_len, enum dma_transfer_direction dir, unsigned long flags, void *context) { struct sun3i_dma_vchan *vchan = to_sun3i_dma_vchan(chan); struct dma_slave_config *sconfig = &vchan->cfg; struct sun3i_dma_promise *promise; struct sun3i_dma_contract *contract; dma_addr_t src, dest; u32 endpoints; int nr_periods, offset, plength, i; sanitize_vchan(vchan); if (!is_slave_direction(dir)) { dev_err(chan2dev(chan), "Invalid DMA direction\n"); return NULL; } if (vchan->is_dedicated) { /* * As we are using this just for audio data, we need to use * normal DMA. There is nothing stopping us from supporting * dedicated DMA here as well, so if a client comes up and * requires it, it will be simple to implement it. */ dev_err(chan2dev(chan), "Cyclic transfers are only supported on Normal DMA\n"); return NULL; } contract = generate_dma_contract(); if (!contract) return NULL; contract->is_cyclic = 1; /* Figure out the endpoints and the address we need */ if (dir == DMA_MEM_TO_DEV) { src = buf; dest = sconfig->dst_addr; endpoints = SUN3I_DMA_CFG_SRC_DRQ_TYPE(SUN3I_NDMA_DRQ_TYPE_SDRAM) | SUN3I_DMA_CFG_DST_DRQ_TYPE(vchan->endpoint) | SUN3I_DMA_CFG_DST_ADDR_MODE(SUN3I_NDMA_ADDR_MODE_IO); } else { src = sconfig->src_addr; dest = buf; endpoints = SUN3I_DMA_CFG_SRC_DRQ_TYPE(vchan->endpoint) | SUN3I_DMA_CFG_SRC_ADDR_MODE(SUN3I_NDMA_ADDR_MODE_IO) | SUN3I_DMA_CFG_DST_DRQ_TYPE(SUN3I_NDMA_DRQ_TYPE_SDRAM); } /* * We will be using half done interrupts to make two periods * out of a promise, so we need to program the DMA engine less * often */ /* * The engine can interrupt on half-transfer, so we can use * this feature to program the engine half as often as if we * didn't use it (keep in mind the hardware doesn't support * linked lists). * * Say you have a set of periods (| marks the start/end, I for * interrupt, P for programming the engine to do a new * transfer), the easy but slow way would be to do * * |---|---|---|---| (periods / promises) * P I,P I,P I,P I * * Using half transfer interrupts you can do * * |-------|-------| (promises as configured on hw) * |---|---|---|---| (periods) * P I I,P I I * * Which requires half the engine programming for the same * functionality. */ nr_periods = DIV_ROUND_UP(len / period_len, 2); for (i = 0; i < nr_periods; i++) { /* Calculate the offset in the buffer and the length needed */ offset = i * period_len * 2; plength = min((len - offset), (period_len * 2)); if (dir == DMA_MEM_TO_DEV) src = buf + offset; else dest = buf + offset; /* Make the promise */ promise = generate_ndma_promise(chan, src, dest, plength, sconfig, dir); if (!promise) { /* TODO: should we free everything? */ return NULL; } promise->cfg |= endpoints; /* Then add it to the contract */ list_add_tail(&promise->list, &contract->demands); } /* And add it to the vchan */ return vchan_tx_prep(&vchan->vc, &contract->vd, flags); } static struct dma_async_tx_descriptor * sun3i_dma_prep_dma_sg(struct dma_chan *chan, struct scatterlist *dst_sg, unsigned int dst_nents, struct scatterlist *src_sg, unsigned int src_nents, unsigned long flags) { struct sun3i_dma_vchan *vchan = to_sun3i_dma_vchan(chan); struct dma_slave_config *sconfig = &vchan->cfg; struct sun3i_dma_promise *promise; struct sun3i_dma_contract *contract; u8 ram_type, io_mode, linear_mode; u32 endpoints; if (dst_nents != src_nents) return NULL; if (!dst_nents || !src_nents) return NULL; if (dst_sg == NULL || src_sg == NULL) return NULL; contract = generate_dma_contract(); if (!contract) return NULL; sanitize_vchan(vchan); if (vchan->is_dedicated) { io_mode = SUN3I_DDMA_ADDR_MODE_IO; linear_mode = SUN3I_DDMA_ADDR_MODE_LINEAR; ram_type = SUN3I_DDMA_DRQ_TYPE_SDRAM; } else { io_mode = SUN3I_NDMA_ADDR_MODE_IO; linear_mode = SUN3I_NDMA_ADDR_MODE_LINEAR; ram_type = SUN3I_NDMA_DRQ_TYPE_SDRAM; } endpoints = SUN3I_DMA_CFG_DST_DRQ_TYPE(ram_type) | SUN3I_DMA_CFG_DST_ADDR_MODE(linear_mode) | SUN3I_DMA_CFG_SRC_DRQ_TYPE(ram_type) | SUN3I_DMA_CFG_SRC_ADDR_MODE(linear_mode); while ((src_sg != NULL) && (dst_sg != NULL)) { /* And make a suitable promise */ if (vchan->is_dedicated) promise = generate_ddma_promise( chan, sg_dma_address(src_sg), sg_dma_address(dst_sg), sg_dma_len(dst_sg), sconfig); else promise = generate_ndma_promise( chan, sg_dma_address(src_sg), sg_dma_address(dst_sg), sg_dma_len(dst_sg), sconfig, DMA_MEM_TO_MEM); if (!promise) return NULL; /* TODO: should we free everything? */ promise->cfg |= endpoints; /* Then add it to the contract */ list_add_tail(&promise->list, &contract->demands); src_sg = sg_next(src_sg); dst_sg = sg_next(dst_sg); } return vchan_tx_prep(&vchan->vc, &contract->vd, flags); } static struct dma_async_tx_descriptor * sun3i_dma_prep_slave_sg(struct dma_chan *chan, struct scatterlist *sgl, unsigned int sg_len, enum dma_transfer_direction dir, unsigned long flags, void *context) { struct sun3i_dma_vchan *vchan = to_sun3i_dma_vchan(chan); struct dma_slave_config *sconfig = &vchan->cfg; struct sun3i_dma_promise *promise; struct sun3i_dma_contract *contract; u8 ram_type, io_mode, linear_mode; struct scatterlist *sg; dma_addr_t srcaddr, dstaddr; u32 endpoints, para; int i; sanitize_vchan(vchan); if (!sgl) return NULL; if (!is_slave_direction(dir)) { dev_err(chan2dev(chan), "Invalid DMA direction\n"); return NULL; } contract = generate_dma_contract(); if (!contract) return NULL; if (vchan->is_dedicated) { io_mode = SUN3I_DDMA_ADDR_MODE_IO; linear_mode = SUN3I_DDMA_ADDR_MODE_LINEAR; ram_type = SUN3I_DDMA_DRQ_TYPE_SDRAM; } else { io_mode = SUN3I_NDMA_ADDR_MODE_IO; linear_mode = SUN3I_NDMA_ADDR_MODE_LINEAR; ram_type = SUN3I_NDMA_DRQ_TYPE_SDRAM; } if (dir == DMA_MEM_TO_DEV) endpoints = SUN3I_DMA_CFG_DST_DRQ_TYPE(vchan->endpoint) | SUN3I_DMA_CFG_DST_ADDR_MODE(io_mode) | SUN3I_DMA_CFG_SRC_DRQ_TYPE(ram_type) | SUN3I_DMA_CFG_SRC_ADDR_MODE(linear_mode); else endpoints = SUN3I_DMA_CFG_DST_DRQ_TYPE(ram_type) | SUN3I_DMA_CFG_DST_ADDR_MODE(linear_mode) | SUN3I_DMA_CFG_SRC_DRQ_TYPE(vchan->endpoint) | SUN3I_DMA_CFG_SRC_ADDR_MODE(io_mode); for_each_sg(sgl, sg, sg_len, i) { /* Figure out addresses */ if (dir == DMA_MEM_TO_DEV) { srcaddr = sg_dma_address(sg); dstaddr = sconfig->dst_addr; } else { srcaddr = sconfig->src_addr; dstaddr = sg_dma_address(sg); } /* * These are the magic DMA engine timings that keep SPI going. * I haven't seen any interface on DMAEngine to configure * timings, and so far they seem to work for everything we * support, so I've kept them here. I don't know if other * devices need different timings because, as usual, we only * have the "para" bitfield meanings, but no comment on what * the values should be when doing a certain operation :| */ para = SUN3I_DDMA_MAGIC_SPI_PARAMETERS; /* And make a suitable promise */ if (vchan->is_dedicated) promise = generate_ddma_promise(chan, srcaddr, dstaddr, sg_dma_len(sg), sconfig); else promise = generate_ndma_promise(chan, srcaddr, dstaddr, sg_dma_len(sg), sconfig, dir); if (!promise) return NULL; /* TODO: should we free everything? */ promise->cfg |= endpoints; promise->para = para; /* Then add it to the contract */ list_add_tail(&promise->list, &contract->demands); } /* * Once we've got all the promises ready, add the contract * to the pending list on the vchan */ return vchan_tx_prep(&vchan->vc, &contract->vd, flags); } static int sun3i_dma_terminate_all(struct dma_chan *chan) { struct sun3i_dma_dev *priv = to_sun3i_dma_dev(chan->device); struct sun3i_dma_vchan *vchan = to_sun3i_dma_vchan(chan); struct sun3i_dma_pchan *pchan = vchan->pchan; LIST_HEAD(head); unsigned long flags; #ifdef TERMINATE_WAIT_DMA struct sun3i_dma_contract *contract; unsigned long cfg_reg = 0x80000000; int delay = 1; u32 len; if (vchan->terminating) return 0; len = SUN3I_PCHAN_INNER_BUFFER_LEN; contract = vchan->contract; #endif spin_lock_irqsave(&vchan->vc.lock, flags); vchan_get_all_descriptors(&vchan->vc, &head); #ifdef TERMINATE_WAIT_DMA vchan->terminating = 1; vchan->vc.cyclic = NULL; if (pchan) { spin_unlock_irqrestore(&vchan->vc.lock, flags); /* when the dma end, it clear this bit automatically */ while ((cfg_reg & 0x80000000) && delay--) { if (pchan->is_dedicated) cfg_reg = readl_relaxed(pchan->base + SUN3I_DDMA_CFG_REG); else cfg_reg = readl_relaxed(pchan->base + SUN3I_NDMA_CFG_REG); } if (delay <= 0) { if (pchan->is_dedicated) { writel_relaxed(0, pchan->base + SUN3I_DDMA_CFG_REG); writel_relaxed(pchan->inner_dma_src, pchan->base + SUN3I_DDMA_SRC_ADDR_REG); writel_relaxed(pchan->inner_dma_dst, pchan->base + SUN3I_DDMA_DST_ADDR_REG); writel_relaxed(len, pchan->base + SUN3I_DDMA_BYTE_COUNT_REG); writel_relaxed(SUN3I_DDMA_SDRAM2SDRAM_CFG, pchan->base + SUN3I_DDMA_CFG_REG); delay = 100; } else { writel_relaxed(0, pchan->base + SUN3I_NDMA_CFG_REG); writel_relaxed(pchan->inner_dma_src, pchan->base + SUN3I_NDMA_SRC_ADDR_REG); writel_relaxed(pchan->inner_dma_dst, pchan->base + SUN3I_NDMA_DST_ADDR_REG); writel_relaxed(len, pchan->base + SUN3I_NDMA_BYTE_COUNT_REG); writel_relaxed(SUN3I_NDMA_SDRAM2SDRAM_CFG, pchan->base + SUN3I_NDMA_CFG_REG); delay = 100; } while ((cfg_reg & 0x80000000) && delay--) { if (pchan->is_dedicated) cfg_reg = readl_relaxed(pchan->base + SUN3I_DDMA_CFG_REG); else cfg_reg = readl_relaxed(pchan->base + SUN3I_NDMA_CFG_REG); } } spin_lock_irqsave(&vchan->vc.lock, flags); } vchan->terminating = 0; #endif spin_unlock_irqrestore(&vchan->vc.lock, flags); /* * Clearing the configuration register will halt the pchan. Interrupts * may still trigger, so don't forget to disable them. */ if (pchan) { if (pchan->is_dedicated) writel(0, pchan->base + SUN3I_DDMA_CFG_REG); else writel(0, pchan->base + SUN3I_NDMA_CFG_REG); set_pchan_interrupt(priv, pchan, 0, 0); release_pchan(priv, pchan); } spin_lock_irqsave(&vchan->vc.lock, flags); vchan_dma_desc_free_list(&vchan->vc, &head); /* Clear these so the vchan is usable again */ release_vchan(vchan); spin_unlock_irqrestore(&vchan->vc.lock, flags); return 0; } static int sun3i_dma_config(struct dma_chan *chan, struct dma_slave_config *config) { struct sun3i_dma_vchan *vchan = to_sun3i_dma_vchan(chan); memcpy(&vchan->cfg, config, sizeof(*config)); return 0; } static struct dma_chan *sun3i_dma_of_xlate(struct of_phandle_args *dma_spec, struct of_dma *ofdma) { struct sun3i_dma_vchan *vchan; struct dma_chan *chan; dma_cap_mask_t mask; u8 is_dedicated = dma_spec->args[0]; u8 endpoint = dma_spec->args[1]; /* Check if type is Normal or Dedicated */ if (is_dedicated != 0 && is_dedicated != 1) return NULL; /* Make sure the endpoint looks sane */ if ((is_dedicated && endpoint >= SUN3I_DDMA_DRQ_TYPE_LIMIT) || (!is_dedicated && endpoint >= SUN3I_NDMA_DRQ_TYPE_LIMIT)) return NULL; dma_cap_zero(mask); dma_cap_set(DMA_SLAVE, mask); chan = __dma_request_channel(&mask, NULL, NULL); if (!chan) return NULL; /* Assign the endpoint to the vchan */ vchan = to_sun3i_dma_vchan(chan); vchan->is_dedicated = is_dedicated; vchan->endpoint = endpoint; return chan; } static enum dma_status sun3i_dma_tx_status(struct dma_chan *chan, dma_cookie_t cookie, struct dma_tx_state *state) { struct sun3i_dma_vchan *vchan = to_sun3i_dma_vchan(chan); struct sun3i_dma_pchan *pchan = vchan->pchan; struct sun3i_dma_contract *contract; struct sun3i_dma_promise *promise; struct virt_dma_desc *vd; unsigned long flags; enum dma_status ret; size_t bytes = 0; ret = dma_cookie_status(chan, cookie, state); if (!state || (ret == DMA_SUCCESS)) return ret; spin_lock_irqsave(&vchan->vc.lock, flags); vd = vchan_find_desc(&vchan->vc, cookie); if (!vd) goto exit; contract = to_sun3i_dma_contract(vd); list_for_each_entry(promise, &contract->demands, list) bytes += promise->len; /* * The hardware is configured to return the remaining byte * quantity. If possible, replace the first listed element's * full size with the actual remaining amount */ promise = list_first_entry_or_null(&contract->demands, struct sun3i_dma_promise, list); if (promise && pchan) { bytes -= promise->len; if (pchan->is_dedicated) bytes += readl(pchan->base + SUN3I_DDMA_BYTE_COUNT_REG); else bytes += readl(pchan->base + SUN3I_NDMA_BYTE_COUNT_REG); } exit: dma_set_residue(state, bytes); spin_unlock_irqrestore(&vchan->vc.lock, flags); return ret; } static void sun3i_dma_issue_pending(struct dma_chan *chan) { struct sun3i_dma_dev *priv = to_sun3i_dma_dev(chan->device); struct sun3i_dma_vchan *vchan = to_sun3i_dma_vchan(chan); unsigned long flags; spin_lock_irqsave(&vchan->vc.lock, flags); /* * If there are pending transactions for this vchan, push one of * them into the engine to get the ball rolling. */ if (vchan_issue_pending(&vchan->vc)) __execute_vchan_pending(priv, vchan); spin_unlock_irqrestore(&vchan->vc.lock, flags); } /* Added by Leson 20151016*/ static int sun3i_dma_control(struct dma_chan *chan, enum dma_ctrl_cmd cmd, unsigned long arg) { int ret = 0; switch (cmd) { case DMA_RESUME: break; case DMA_PAUSE: ret = sun3i_dma_terminate_all(chan); break; case DMA_TERMINATE_ALL: ret = sun3i_dma_terminate_all(chan); break; case DMA_SLAVE_CONFIG: ret = sun3i_dma_config(chan, (struct dma_slave_config *)arg); break; default: ret = -ENXIO; break; } return ret; } static void sun3i_vchan_cyclic_callback(struct virt_dma_desc *vd) { struct virt_dma_chan *vc = to_virt_chan(vd->tx.chan); dma_async_tx_callback cb = NULL; void *cb_data = NULL; if (vd) { cb = vd->tx.callback; cb_data = vd->tx.callback_param; } spin_unlock(&vc->lock); if (cb) cb(cb_data); spin_lock(&vc->lock); } static irqreturn_t sun3i_dma_interrupt(int irq, void *dev_id) { struct sun3i_dma_dev *priv = dev_id; struct sun3i_dma_pchan *pchans = priv->pchans, *pchan; struct sun3i_dma_vchan *vchan; struct sun3i_dma_contract *contract; struct sun3i_dma_promise *promise; unsigned long pendirq, irqs, disableirqs; int bit, i, free_room, allow_mitigation = 1; pendirq = readl_relaxed(priv->base + SUN3I_DMA_IRQ_PENDING_STATUS_REG); handle_pending: disableirqs = 0; free_room = 0; for_each_set_bit(bit, &pendirq, 32) { pchan = &pchans[bit >> 1]; vchan = pchan->vchan; if (!vchan) /* a terminated channel may still interrupt */ continue; contract = vchan->contract; /* * Disable the IRQ and free the pchan if it's an end * interrupt (odd bit) */ if (bit & 1) { spin_lock(&vchan->vc.lock); /* * Move the promise into the completed list now that * we're done with it */ list_del(&vchan->processing->list); list_add_tail(&vchan->processing->list, &contract->completed_demands); /* * Cyclic DMA transfers are special: * - There's always something we can dispatch * - We need to run the callback * - Latency is very important, as this is used by audio * We therefore just cycle through the list and dispatch * whatever we have here, reusing the pchan. There's * no need to run the thread after this. * * For non-cyclic transfers we need to look around, * so we can program some more work, or notify the * client that their transfers have been completed. */ if (vchan->terminating) { disableirqs |= BIT(bit); } else if (contract->is_cyclic) { promise = get_next_cyclic_promise(contract); vchan->processing = promise; configure_pchan(pchan, promise); sun3i_vchan_cyclic_callback(&contract->vd); } else { vchan->processing = NULL; vchan->pchan = NULL; free_room = 1; disableirqs |= BIT(bit); release_pchan(priv, pchan); release_pchan_cyclic(priv, pchan); } spin_unlock(&vchan->vc.lock); } else { /* Half done interrupt */ if (vchan->terminating) disableirqs |= BIT(bit); else if (contract->is_cyclic) sun3i_vchan_cyclic_callback(&contract->vd); else disableirqs |= BIT(bit); } } /* Disable the IRQs for events we handled */ spin_lock(&priv->lock); irqs = readl_relaxed(priv->base + SUN3I_DMA_IRQ_ENABLE_REG); writel_relaxed(irqs & ~disableirqs, priv->base + SUN3I_DMA_IRQ_ENABLE_REG); spin_unlock(&priv->lock); /* Writing 1 to the pending field will clear the pending interrupt */ writel_relaxed(pendirq, priv->base + SUN3I_DMA_IRQ_PENDING_STATUS_REG); /* * If a pchan was freed, we may be able to schedule something else, * so have a look around */ if (free_room) { for (i = 0; i < SUN3I_DMA_NR_MAX_VCHANS; i++) { vchan = &priv->vchans[i]; spin_lock(&vchan->vc.lock); __execute_vchan_pending(priv, vchan); spin_unlock(&vchan->vc.lock); } } /* * Handle newer interrupts if some showed up, but only do it once * to avoid a too long a loop */ if (allow_mitigation) { pendirq = readl_relaxed(priv->base + SUN3I_DMA_IRQ_PENDING_STATUS_REG); if (pendirq) { allow_mitigation = 0; goto handle_pending; } } return IRQ_HANDLED; } static int sun3i_dma_probe(struct platform_device *pdev) { struct sun3i_dma_dev *priv; struct resource *res; int i, j, ret; size_t len = SUN3I_PCHAN_INNER_BUFFER_LEN; priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); if (!priv) return -ENOMEM; res = platform_get_resource(pdev, IORESOURCE_MEM, 0); priv->base = devm_ioremap_resource(&pdev->dev, res); if (IS_ERR(priv->base)) return PTR_ERR(priv->base); priv->irq = platform_get_irq(pdev, 0); if (priv->irq < 0) { dev_err(&pdev->dev, "Cannot claim IRQ\n"); return priv->irq; } priv->clk = devm_clk_get(&pdev->dev, NULL); if (IS_ERR(priv->clk)) { dev_err(&pdev->dev, "No clock specified\n"); return PTR_ERR(priv->clk); } platform_set_drvdata(pdev, priv); spin_lock_init(&priv->lock); dma_cap_zero(priv->slave.cap_mask); dma_cap_set(DMA_PRIVATE, priv->slave.cap_mask); dma_cap_set(DMA_MEMCPY, priv->slave.cap_mask); dma_cap_set(DMA_CYCLIC, priv->slave.cap_mask); dma_cap_set(DMA_SLAVE, priv->slave.cap_mask); dma_cap_set(DMA_SG, priv->slave.cap_mask); INIT_LIST_HEAD(&priv->slave.channels); priv->slave.device_alloc_chan_resources = sun3i_dma_alloc_chan_resources; priv->slave.device_free_chan_resources = sun3i_dma_free_chan_resources; priv->slave.device_tx_status = sun3i_dma_tx_status; priv->slave.device_issue_pending = sun3i_dma_issue_pending; priv->slave.device_prep_slave_sg = sun3i_dma_prep_slave_sg; priv->slave.device_prep_dma_memcpy = sun3i_dma_prep_dma_memcpy; priv->slave.device_prep_dma_cyclic = sun3i_dma_prep_dma_cyclic; priv->slave.device_prep_dma_sg = sun3i_dma_prep_dma_sg; priv->slave.device_control = sun3i_dma_control; priv->slave.copy_align = 2; priv->slave.dev = &pdev->dev; priv->pchans = devm_kcalloc( &pdev->dev, SUN3I_DMA_NR_MAX_CHANNELS, sizeof(struct sun3i_dma_pchan), GFP_KERNEL); priv->vchans = devm_kcalloc( &pdev->dev, SUN3I_DMA_NR_MAX_VCHANS, sizeof(struct sun3i_dma_vchan), GFP_KERNEL); if (!priv->vchans || !priv->pchans) return -ENOMEM; /* * [0..SUN3I_NDMA_NR_MAX_CHANNELS) are normal pchans, and * [SUN3I_NDMA_NR_MAX_CHANNELS..SUN3I_DMA_NR_MAX_CHANNELS) are * dedicated ones */ for (i = 0; i < SUN3I_NDMA_NR_MAX_CHANNELS; i++) { priv->pchans[i].base = priv->base + SUN3I_NDMA_CHANNEL_REG_BASE(i); priv->pchans[i].inner_buf_src = kmalloc(len, GFP_KERNEL); priv->pchans[i].inner_buf_dst = kmalloc(len, GFP_KERNEL); priv->pchans[i].inner_dma_src = dma_map_single(priv->slave.dev, priv->pchans[i].inner_buf_src, len, DMA_TO_DEVICE); priv->pchans[i].inner_dma_dst = dma_map_single(priv->slave.dev, priv->pchans[i].inner_buf_dst, len, DMA_FROM_DEVICE); } for (j = 0; i < SUN3I_DMA_NR_MAX_CHANNELS; i++, j++) { priv->pchans[i].base = priv->base + SUN3I_DDMA_CHANNEL_REG_BASE(j); priv->pchans[i].is_dedicated = 1; priv->pchans[i].inner_buf_src = kmalloc(len, GFP_KERNEL); priv->pchans[i].inner_buf_dst = kmalloc(len, GFP_KERNEL); priv->pchans[i].inner_dma_src = dma_map_single(priv->slave.dev, priv->pchans[i].inner_buf_src, len, DMA_TO_DEVICE); priv->pchans[i].inner_dma_dst = dma_map_single(priv->slave.dev, priv->pchans[i].inner_buf_dst, len, DMA_FROM_DEVICE); } for (i = 0; i < SUN3I_DMA_NR_MAX_VCHANS; i++) { struct sun3i_dma_vchan *vchan = &priv->vchans[i]; spin_lock_init(&vchan->vc.lock); vchan->vc.desc_free = sun3i_dma_free_contract; vchan->endpoint = SUN3I_DMA_DRQ_TYPE_NONE; vchan->terminating = 0; vchan_init(&vchan->vc, &priv->slave); } ret = clk_prepare_enable(priv->clk); if (ret) { dev_err(&pdev->dev, "Couldn't enable the clock\n"); return ret; } /* * Make sure the IRQs are all disabled and accounted for. The bootloader * likes to leave these dirty */ writel(0, priv->base + SUN3I_DMA_IRQ_ENABLE_REG); writel(0xFFFFFFFF, priv->base + SUN3I_DMA_IRQ_PENDING_STATUS_REG); ret = devm_request_irq(&pdev->dev, priv->irq, sun3i_dma_interrupt, 0, dev_name(&pdev->dev), priv); if (ret) { dev_err(&pdev->dev, "Cannot request IRQ\n"); goto err_clk_disable; } ret = dma_async_device_register(&priv->slave); if (ret) { dev_warn(&pdev->dev, "Failed to register DMA engine device\n"); goto err_clk_disable; } ret = of_dma_controller_register(pdev->dev.of_node, sun3i_dma_of_xlate, priv); if (ret) { dev_err(&pdev->dev, "of_dma_controller_register failed\n"); goto err_dma_unregister; } dev_dbg(&pdev->dev, "Successfully probed sun3i_DMA\n"); return 0; err_dma_unregister: dma_async_device_unregister(&priv->slave); err_clk_disable: clk_disable_unprepare(priv->clk); return ret; } static int sun3i_dma_remove(struct platform_device *pdev) { struct sun3i_dma_dev *priv = platform_get_drvdata(pdev); int i, j; size_t len = SUN3I_PCHAN_INNER_BUFFER_LEN; /* Disable IRQ so no more work is scheduled */ disable_irq(priv->irq); for (i = 0; i < SUN3I_NDMA_NR_MAX_CHANNELS; i++) { dma_unmap_single(priv->slave.dev, priv->pchans[i].inner_dma_src, len, DMA_TO_DEVICE); dma_unmap_single(priv->slave.dev, priv->pchans[i].inner_dma_dst, len, DMA_FROM_DEVICE); kfree(priv->pchans[i].inner_buf_src); kfree(priv->pchans[i].inner_buf_dst); } for (j = 0; i < SUN3I_DMA_NR_MAX_CHANNELS; i++, j++) { dma_unmap_single(priv->slave.dev, priv->pchans[i].inner_dma_src, len, DMA_TO_DEVICE); dma_unmap_single(priv->slave.dev, priv->pchans[i].inner_dma_dst, len, DMA_FROM_DEVICE); kfree(priv->pchans[i].inner_buf_src); kfree(priv->pchans[i].inner_buf_dst); } of_dma_controller_free(pdev->dev.of_node); dma_async_device_unregister(&priv->slave); clk_disable_unprepare(priv->clk); return 0; } static const struct of_device_id sun3i_dma_match[] = { {.compatible = "allwinner,sun3i-dma"}, { /* sentinel */ }, }; static struct platform_driver sun3i_dma_driver = { .probe = sun3i_dma_probe, .remove = sun3i_dma_remove, .driver = { .name = "sunxi_dmac", .of_match_table = sun3i_dma_match, }, }; module_platform_driver(sun3i_dma_driver); MODULE_DESCRIPTION("Allwinner SUN3I DMA Controller Driver"); MODULE_AUTHOR("zhuangqiubin "); MODULE_LICENSE("GPL");