123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290 |
- /*
- * Copyright (C) 2014 Emilio López
- * Emilio López <emilio@elopez.com.ar>
- *
- * 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 <linux/bitmap.h>
- #include <linux/bitops.h>
- #include <linux/clk.h>
- #include <linux/dmaengine.h>
- #include <linux/dmapool.h>
- #include <linux/interrupt.h>
- #include <linux/module.h>
- #include <linux/of_dma.h>
- #include <linux/platform_device.h>
- #include <linux/slab.h>
- #include <linux/spinlock.h>
- #include "virt-dma.h"
- /** Common macros to normal and dedicated DMA registers **/
- #define SUN4I_DMA_CFG_LOADING BIT(31)
- #define SUN4I_DMA_CFG_DST_DATA_WIDTH(width) ((width) << 25)
- #define SUN4I_DMA_CFG_DST_BURST_LENGTH(len) ((len) << 23)
- #define SUN4I_DMA_CFG_DST_ADDR_MODE(mode) ((mode) << 21)
- #define SUN4I_DMA_CFG_DST_DRQ_TYPE(type) ((type) << 16)
- #define SUN4I_DMA_CFG_SRC_DATA_WIDTH(width) ((width) << 9)
- #define SUN4I_DMA_CFG_SRC_BURST_LENGTH(len) ((len) << 7)
- #define SUN4I_DMA_CFG_SRC_ADDR_MODE(mode) ((mode) << 5)
- #define SUN4I_DMA_CFG_SRC_DRQ_TYPE(type) (type)
- /** Normal DMA register values **/
- /* Normal DMA source/destination data request type values */
- #define SUN4I_NDMA_DRQ_TYPE_SDRAM 0x16
- #define SUN4I_NDMA_DRQ_TYPE_LIMIT (0x1F + 1)
- /** Normal DMA register layout **/
- /* Dedicated DMA source/destination address mode values */
- #define SUN4I_NDMA_ADDR_MODE_LINEAR 0
- #define SUN4I_NDMA_ADDR_MODE_IO 1
- /* Normal DMA configuration register layout */
- #define SUN4I_NDMA_CFG_CONT_MODE BIT(30)
- #define SUN4I_NDMA_CFG_WAIT_STATE(n) ((n) << 27)
- #define SUN4I_NDMA_CFG_DST_NON_SECURE BIT(22)
- #define SUN4I_NDMA_CFG_BYTE_COUNT_MODE_REMAIN BIT(15)
- #define SUN4I_NDMA_CFG_SRC_NON_SECURE BIT(6)
- /** Dedicated DMA register values **/
- /* Dedicated DMA source/destination address mode values */
- #define SUN4I_DDMA_ADDR_MODE_LINEAR 0
- #define SUN4I_DDMA_ADDR_MODE_IO 1
- #define SUN4I_DDMA_ADDR_MODE_HORIZONTAL_PAGE 2
- #define SUN4I_DDMA_ADDR_MODE_VERTICAL_PAGE 3
- /* Dedicated DMA source/destination data request type values */
- #define SUN4I_DDMA_DRQ_TYPE_SDRAM 0x1
- #define SUN4I_DDMA_DRQ_TYPE_LIMIT (0x1F + 1)
- /** Dedicated DMA register layout **/
- /* Dedicated DMA configuration register layout */
- #define SUN4I_DDMA_CFG_BUSY BIT(30)
- #define SUN4I_DDMA_CFG_CONT_MODE BIT(29)
- #define SUN4I_DDMA_CFG_DST_NON_SECURE BIT(28)
- #define SUN4I_DDMA_CFG_BYTE_COUNT_MODE_REMAIN BIT(15)
- #define SUN4I_DDMA_CFG_SRC_NON_SECURE BIT(12)
- /* Dedicated DMA parameter register layout */
- #define SUN4I_DDMA_PARA_DST_DATA_BLK_SIZE(n) (((n) - 1) << 24)
- #define SUN4I_DDMA_PARA_DST_WAIT_CYCLES(n) (((n) - 1) << 16)
- #define SUN4I_DDMA_PARA_SRC_DATA_BLK_SIZE(n) (((n) - 1) << 8)
- #define SUN4I_DDMA_PARA_SRC_WAIT_CYCLES(n) (((n) - 1) << 0)
- /** DMA register offsets **/
- /* General register offsets */
- #define SUN4I_DMA_IRQ_ENABLE_REG 0x0
- #define SUN4I_DMA_IRQ_PENDING_STATUS_REG 0x4
- /* Normal DMA register offsets */
- #define SUN4I_NDMA_CHANNEL_REG_BASE(n) (0x100 + (n) * 0x20)
- #define SUN4I_NDMA_CFG_REG 0x0
- #define SUN4I_NDMA_SRC_ADDR_REG 0x4
- #define SUN4I_NDMA_DST_ADDR_REG 0x8
- #define SUN4I_NDMA_BYTE_COUNT_REG 0xC
- /* Dedicated DMA register offsets */
- #define SUN4I_DDMA_CHANNEL_REG_BASE(n) (0x300 + (n) * 0x20)
- #define SUN4I_DDMA_CFG_REG 0x0
- #define SUN4I_DDMA_SRC_ADDR_REG 0x4
- #define SUN4I_DDMA_DST_ADDR_REG 0x8
- #define SUN4I_DDMA_BYTE_COUNT_REG 0xC
- #define SUN4I_DDMA_PARA_REG 0x18
- /** 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 SUN4I_NDMA_NR_MAX_CHANNELS 8
- #define SUN4I_DDMA_NR_MAX_CHANNELS 8
- #define SUN4I_DMA_NR_MAX_CHANNELS \
- (SUN4I_NDMA_NR_MAX_CHANNELS + SUN4I_DDMA_NR_MAX_CHANNELS)
- #define SUN4I_NDMA_NR_MAX_VCHANS (29 * 2 - 1)
- #define SUN4I_DDMA_NR_MAX_VCHANS 21
- #define SUN4I_DMA_NR_MAX_VCHANS \
- (SUN4I_NDMA_NR_MAX_VCHANS + SUN4I_DDMA_NR_MAX_VCHANS)
- /* This set of SUN4I_DDMA timing parameters were found experimentally while
- * working with the SPI driver and seem to make it behave correctly */
- #define SUN4I_DDMA_MAGIC_SPI_PARAMETERS \
- (SUN4I_DDMA_PARA_DST_DATA_BLK_SIZE(1) | \
- SUN4I_DDMA_PARA_SRC_DATA_BLK_SIZE(1) | \
- SUN4I_DDMA_PARA_DST_WAIT_CYCLES(2) | \
- SUN4I_DDMA_PARA_SRC_WAIT_CYCLES(2))
- struct sun4i_dma_pchan {
- /* Register base of channel */
- void __iomem *base;
- /* vchan currently being serviced */
- struct sun4i_dma_vchan *vchan;
- /* Is this a dedicated pchan? */
- int is_dedicated;
- };
- struct sun4i_dma_vchan {
- struct virt_dma_chan vc;
- struct dma_slave_config cfg;
- struct sun4i_dma_pchan *pchan;
- struct sun4i_dma_promise *processing;
- struct sun4i_dma_contract *contract;
- u8 endpoint;
- int is_dedicated;
- };
- struct sun4i_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 sun4i_dma_contract {
- struct virt_dma_desc vd;
- struct list_head demands;
- struct list_head completed_demands;
- int is_cyclic;
- };
- struct sun4i_dma_dev {
- DECLARE_BITMAP(pchans_used, SUN4I_DMA_NR_MAX_CHANNELS);
- struct dma_device slave;
- struct sun4i_dma_pchan *pchans;
- struct sun4i_dma_vchan *vchans;
- void __iomem *base;
- struct clk *clk;
- int irq;
- spinlock_t lock;
- };
- static struct sun4i_dma_dev *to_sun4i_dma_dev(struct dma_device *dev)
- {
- return container_of(dev, struct sun4i_dma_dev, slave);
- }
- static struct sun4i_dma_vchan *to_sun4i_dma_vchan(struct dma_chan *chan)
- {
- return container_of(chan, struct sun4i_dma_vchan, vc.chan);
- }
- static struct sun4i_dma_contract *to_sun4i_dma_contract(struct virt_dma_desc *vd)
- {
- return container_of(vd, struct sun4i_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;
- /* 1 -> 0, 4 -> 1, 8 -> 2 */
- 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 void sun4i_dma_free_chan_resources(struct dma_chan *chan)
- {
- struct sun4i_dma_vchan *vchan = to_sun4i_dma_vchan(chan);
- vchan_free_chan_resources(&vchan->vc);
- }
- static struct sun4i_dma_pchan *find_and_use_pchan(struct sun4i_dma_dev *priv,
- struct sun4i_dma_vchan *vchan)
- {
- struct sun4i_dma_pchan *pchan = NULL, *pchans = priv->pchans;
- unsigned long flags;
- int i, max;
- /*
- * pchans 0-SUN4I_NDMA_NR_MAX_CHANNELS are normal, and
- * SUN4I_NDMA_NR_MAX_CHANNELS+ are dedicated ones
- */
- if (vchan->is_dedicated) {
- i = SUN4I_NDMA_NR_MAX_CHANNELS;
- max = SUN4I_DMA_NR_MAX_CHANNELS;
- } else {
- i = 0;
- max = SUN4I_NDMA_NR_MAX_CHANNELS;
- }
- spin_lock_irqsave(&priv->lock, flags);
- for_each_clear_bit_from(i, &priv->pchans_used, max) {
- pchan = &pchans[i];
- pchan->vchan = vchan;
- set_bit(i, priv->pchans_used);
- break;
- }
- spin_unlock_irqrestore(&priv->lock, flags);
- return pchan;
- }
- static void release_pchan(struct sun4i_dma_dev *priv,
- struct sun4i_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 sun4i_dma_pchan *pchan,
- struct sun4i_dma_promise *d)
- {
- /*
- * Configure addresses and misc parameters depending on type
- * SUN4I_DDMA has an extra field with timing parameters
- */
- if (pchan->is_dedicated) {
- writel_relaxed(d->src, pchan->base + SUN4I_DDMA_SRC_ADDR_REG);
- writel_relaxed(d->dst, pchan->base + SUN4I_DDMA_DST_ADDR_REG);
- writel_relaxed(d->len, pchan->base + SUN4I_DDMA_BYTE_COUNT_REG);
- writel_relaxed(d->para, pchan->base + SUN4I_DDMA_PARA_REG);
- writel_relaxed(d->cfg, pchan->base + SUN4I_DDMA_CFG_REG);
- } else {
- writel_relaxed(d->src, pchan->base + SUN4I_NDMA_SRC_ADDR_REG);
- writel_relaxed(d->dst, pchan->base + SUN4I_NDMA_DST_ADDR_REG);
- writel_relaxed(d->len, pchan->base + SUN4I_NDMA_BYTE_COUNT_REG);
- writel_relaxed(d->cfg, pchan->base + SUN4I_NDMA_CFG_REG);
- }
- }
- static void set_pchan_interrupt(struct sun4i_dma_dev *priv,
- struct sun4i_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 + SUN4I_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 + SUN4I_DMA_IRQ_ENABLE_REG);
- spin_unlock_irqrestore(&priv->lock, flags);
- }
- /**
- * 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 sun4i_dma_dev *priv,
- struct sun4i_dma_vchan *vchan)
- {
- struct sun4i_dma_promise *promise = NULL;
- struct sun4i_dma_contract *contract = NULL;
- struct sun4i_dma_pchan *pchan;
- struct virt_dma_desc *vd;
- int ret;
- lockdep_assert_held(&vchan->vc.lock);
- /* We need a pchan to do anything, so secure one if available */
- pchan = find_and_use_pchan(priv, vchan);
- 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_sun4i_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 sun4i_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;
- }
- /**
- * 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 sun4i_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 sun4i_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 = SUN4I_DMA_CFG_LOADING |
- SUN4I_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 (ret < 0)
- goto fail;
- promise->cfg |= SUN4I_DMA_CFG_SRC_BURST_LENGTH(ret);
- /* Destination burst */
- ret = convert_burst(sconfig->dst_maxburst);
- if (ret < 0)
- goto fail;
- promise->cfg |= SUN4I_DMA_CFG_DST_BURST_LENGTH(ret);
- /* Source bus width */
- ret = convert_buswidth(sconfig->src_addr_width);
- if (ret < 0)
- goto fail;
- promise->cfg |= SUN4I_DMA_CFG_SRC_DATA_WIDTH(ret);
- /* Destination bus width */
- ret = convert_buswidth(sconfig->dst_addr_width);
- if (ret < 0)
- goto fail;
- promise->cfg |= SUN4I_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 sun4i_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 sun4i_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 = SUN4I_DMA_CFG_LOADING |
- SUN4I_DDMA_CFG_BYTE_COUNT_MODE_REMAIN;
- /* Source burst */
- ret = convert_burst(sconfig->src_maxburst);
- if (ret < 0)
- goto fail;
- promise->cfg |= SUN4I_DMA_CFG_SRC_BURST_LENGTH(ret);
- /* Destination burst */
- ret = convert_burst(sconfig->dst_maxburst);
- if (ret < 0)
- goto fail;
- promise->cfg |= SUN4I_DMA_CFG_DST_BURST_LENGTH(ret);
- /* Source bus width */
- ret = convert_buswidth(sconfig->src_addr_width);
- if (ret < 0)
- goto fail;
- promise->cfg |= SUN4I_DMA_CFG_SRC_DATA_WIDTH(ret);
- /* Destination bus width */
- ret = convert_buswidth(sconfig->dst_addr_width);
- if (ret < 0)
- goto fail;
- promise->cfg |= SUN4I_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 sun4i_dma_contract *generate_dma_contract(void)
- {
- struct sun4i_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 sun4i_dma_promise *
- get_next_cyclic_promise(struct sun4i_dma_contract *contract)
- {
- struct sun4i_dma_promise *promise;
- promise = list_first_entry_or_null(&contract->demands,
- struct sun4i_dma_promise, list);
- if (!promise) {
- list_splice_init(&contract->completed_demands,
- &contract->demands);
- promise = list_first_entry(&contract->demands,
- struct sun4i_dma_promise, list);
- }
- return promise;
- }
- /**
- * Free a contract and all its associated promises
- */
- static void sun4i_dma_free_contract(struct virt_dma_desc *vd)
- {
- struct sun4i_dma_contract *contract = to_sun4i_dma_contract(vd);
- struct sun4i_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 *
- sun4i_dma_prep_dma_memcpy(struct dma_chan *chan, dma_addr_t dest,
- dma_addr_t src, size_t len, unsigned long flags)
- {
- struct sun4i_dma_vchan *vchan = to_sun4i_dma_vchan(chan);
- struct dma_slave_config *sconfig = &vchan->cfg;
- struct sun4i_dma_promise *promise;
- struct sun4i_dma_contract *contract;
- 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 = 8;
- sconfig->dst_maxburst = 8;
- 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 |= SUN4I_DMA_CFG_SRC_DRQ_TYPE(SUN4I_DDMA_DRQ_TYPE_SDRAM) |
- SUN4I_DMA_CFG_DST_DRQ_TYPE(SUN4I_DDMA_DRQ_TYPE_SDRAM);
- } else {
- promise->cfg |= SUN4I_DMA_CFG_SRC_DRQ_TYPE(SUN4I_NDMA_DRQ_TYPE_SDRAM) |
- SUN4I_DMA_CFG_DST_DRQ_TYPE(SUN4I_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 *
- sun4i_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)
- {
- struct sun4i_dma_vchan *vchan = to_sun4i_dma_vchan(chan);
- struct dma_slave_config *sconfig = &vchan->cfg;
- struct sun4i_dma_promise *promise;
- struct sun4i_dma_contract *contract;
- dma_addr_t src, dest;
- u32 endpoints;
- int nr_periods, offset, plength, i;
- 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 = SUN4I_DMA_CFG_SRC_DRQ_TYPE(SUN4I_NDMA_DRQ_TYPE_SDRAM) |
- SUN4I_DMA_CFG_DST_DRQ_TYPE(vchan->endpoint) |
- SUN4I_DMA_CFG_DST_ADDR_MODE(SUN4I_NDMA_ADDR_MODE_IO);
- } else {
- src = sconfig->src_addr;
- dest = buf;
- endpoints = SUN4I_DMA_CFG_SRC_DRQ_TYPE(vchan->endpoint) |
- SUN4I_DMA_CFG_SRC_ADDR_MODE(SUN4I_NDMA_ADDR_MODE_IO) |
- SUN4I_DMA_CFG_DST_DRQ_TYPE(SUN4I_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 *
- sun4i_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 sun4i_dma_vchan *vchan = to_sun4i_dma_vchan(chan);
- struct dma_slave_config *sconfig = &vchan->cfg;
- struct sun4i_dma_promise *promise;
- struct sun4i_dma_contract *contract;
- u8 ram_type, io_mode, linear_mode;
- struct scatterlist *sg;
- dma_addr_t srcaddr, dstaddr;
- u32 endpoints, para;
- int i;
- 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 = SUN4I_DDMA_ADDR_MODE_IO;
- linear_mode = SUN4I_DDMA_ADDR_MODE_LINEAR;
- ram_type = SUN4I_DDMA_DRQ_TYPE_SDRAM;
- } else {
- io_mode = SUN4I_NDMA_ADDR_MODE_IO;
- linear_mode = SUN4I_NDMA_ADDR_MODE_LINEAR;
- ram_type = SUN4I_NDMA_DRQ_TYPE_SDRAM;
- }
- if (dir == DMA_MEM_TO_DEV)
- endpoints = SUN4I_DMA_CFG_DST_DRQ_TYPE(vchan->endpoint) |
- SUN4I_DMA_CFG_DST_ADDR_MODE(io_mode) |
- SUN4I_DMA_CFG_SRC_DRQ_TYPE(ram_type) |
- SUN4I_DMA_CFG_SRC_ADDR_MODE(linear_mode);
- else
- endpoints = SUN4I_DMA_CFG_DST_DRQ_TYPE(ram_type) |
- SUN4I_DMA_CFG_DST_ADDR_MODE(linear_mode) |
- SUN4I_DMA_CFG_SRC_DRQ_TYPE(vchan->endpoint) |
- SUN4I_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 = SUN4I_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 sun4i_dma_terminate_all(struct dma_chan *chan)
- {
- struct sun4i_dma_dev *priv = to_sun4i_dma_dev(chan->device);
- struct sun4i_dma_vchan *vchan = to_sun4i_dma_vchan(chan);
- struct sun4i_dma_pchan *pchan = vchan->pchan;
- LIST_HEAD(head);
- unsigned long flags;
- spin_lock_irqsave(&vchan->vc.lock, flags);
- vchan_get_all_descriptors(&vchan->vc, &head);
- 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 + SUN4I_DDMA_CFG_REG);
- else
- writel(0, pchan->base + SUN4I_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 */
- vchan->processing = NULL;
- vchan->pchan = NULL;
- spin_unlock_irqrestore(&vchan->vc.lock, flags);
- return 0;
- }
- static int sun4i_dma_config(struct dma_chan *chan,
- struct dma_slave_config *config)
- {
- struct sun4i_dma_vchan *vchan = to_sun4i_dma_vchan(chan);
- memcpy(&vchan->cfg, config, sizeof(*config));
- return 0;
- }
- static struct dma_chan *sun4i_dma_of_xlate(struct of_phandle_args *dma_spec,
- struct of_dma *ofdma)
- {
- struct sun4i_dma_dev *priv = ofdma->of_dma_data;
- struct sun4i_dma_vchan *vchan;
- struct dma_chan *chan;
- 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 >= SUN4I_DDMA_DRQ_TYPE_LIMIT) ||
- (!is_dedicated && endpoint >= SUN4I_NDMA_DRQ_TYPE_LIMIT))
- return NULL;
- chan = dma_get_any_slave_channel(&priv->slave);
- if (!chan)
- return NULL;
- /* Assign the endpoint to the vchan */
- vchan = to_sun4i_dma_vchan(chan);
- vchan->is_dedicated = is_dedicated;
- vchan->endpoint = endpoint;
- return chan;
- }
- static enum dma_status sun4i_dma_tx_status(struct dma_chan *chan,
- dma_cookie_t cookie,
- struct dma_tx_state *state)
- {
- struct sun4i_dma_vchan *vchan = to_sun4i_dma_vchan(chan);
- struct sun4i_dma_pchan *pchan = vchan->pchan;
- struct sun4i_dma_contract *contract;
- struct sun4i_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_COMPLETE))
- return ret;
- spin_lock_irqsave(&vchan->vc.lock, flags);
- vd = vchan_find_desc(&vchan->vc, cookie);
- if (!vd)
- goto exit;
- contract = to_sun4i_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 sun4i_dma_promise, list);
- if (promise && pchan) {
- bytes -= promise->len;
- if (pchan->is_dedicated)
- bytes += readl(pchan->base + SUN4I_DDMA_BYTE_COUNT_REG);
- else
- bytes += readl(pchan->base + SUN4I_NDMA_BYTE_COUNT_REG);
- }
- exit:
- dma_set_residue(state, bytes);
- spin_unlock_irqrestore(&vchan->vc.lock, flags);
- return ret;
- }
- static void sun4i_dma_issue_pending(struct dma_chan *chan)
- {
- struct sun4i_dma_dev *priv = to_sun4i_dma_dev(chan->device);
- struct sun4i_dma_vchan *vchan = to_sun4i_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);
- }
- static irqreturn_t sun4i_dma_interrupt(int irq, void *dev_id)
- {
- struct sun4i_dma_dev *priv = dev_id;
- struct sun4i_dma_pchan *pchans = priv->pchans, *pchan;
- struct sun4i_dma_vchan *vchan;
- struct sun4i_dma_contract *contract;
- struct sun4i_dma_promise *promise;
- unsigned long pendirq, irqs, disableirqs;
- int bit, i, free_room, allow_mitigation = 1;
- pendirq = readl_relaxed(priv->base + SUN4I_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 (contract->is_cyclic) {
- promise = get_next_cyclic_promise(contract);
- vchan->processing = promise;
- configure_pchan(pchan, promise);
- vchan_cyclic_callback(&contract->vd);
- } else {
- vchan->processing = NULL;
- vchan->pchan = NULL;
- free_room = 1;
- disableirqs |= BIT(bit);
- release_pchan(priv, pchan);
- }
- spin_unlock(&vchan->vc.lock);
- } else {
- /* Half done interrupt */
- if (contract->is_cyclic)
- 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 + SUN4I_DMA_IRQ_ENABLE_REG);
- writel_relaxed(irqs & ~disableirqs,
- priv->base + SUN4I_DMA_IRQ_ENABLE_REG);
- spin_unlock(&priv->lock);
- /* Writing 1 to the pending field will clear the pending interrupt */
- writel_relaxed(pendirq, priv->base + SUN4I_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 < SUN4I_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 +
- SUN4I_DMA_IRQ_PENDING_STATUS_REG);
- if (pendirq) {
- allow_mitigation = 0;
- goto handle_pending;
- }
- }
- return IRQ_HANDLED;
- }
- static int sun4i_dma_probe(struct platform_device *pdev)
- {
- struct sun4i_dma_dev *priv;
- struct resource *res;
- int i, j, ret;
- 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);
- INIT_LIST_HEAD(&priv->slave.channels);
- priv->slave.device_free_chan_resources = sun4i_dma_free_chan_resources;
- priv->slave.device_tx_status = sun4i_dma_tx_status;
- priv->slave.device_issue_pending = sun4i_dma_issue_pending;
- priv->slave.device_prep_slave_sg = sun4i_dma_prep_slave_sg;
- priv->slave.device_prep_dma_memcpy = sun4i_dma_prep_dma_memcpy;
- priv->slave.device_prep_dma_cyclic = sun4i_dma_prep_dma_cyclic;
- priv->slave.device_config = sun4i_dma_config;
- priv->slave.device_terminate_all = sun4i_dma_terminate_all;
- priv->slave.copy_align = 2;
- priv->slave.src_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_1_BYTE) |
- BIT(DMA_SLAVE_BUSWIDTH_2_BYTES) |
- BIT(DMA_SLAVE_BUSWIDTH_4_BYTES);
- priv->slave.dst_addr_widths = BIT(DMA_SLAVE_BUSWIDTH_1_BYTE) |
- BIT(DMA_SLAVE_BUSWIDTH_2_BYTES) |
- BIT(DMA_SLAVE_BUSWIDTH_4_BYTES);
- priv->slave.directions = BIT(DMA_DEV_TO_MEM) |
- BIT(DMA_MEM_TO_DEV);
- priv->slave.residue_granularity = DMA_RESIDUE_GRANULARITY_BURST;
- priv->slave.dev = &pdev->dev;
- priv->pchans = devm_kcalloc(&pdev->dev, SUN4I_DMA_NR_MAX_CHANNELS,
- sizeof(struct sun4i_dma_pchan), GFP_KERNEL);
- priv->vchans = devm_kcalloc(&pdev->dev, SUN4I_DMA_NR_MAX_VCHANS,
- sizeof(struct sun4i_dma_vchan), GFP_KERNEL);
- if (!priv->vchans || !priv->pchans)
- return -ENOMEM;
- /*
- * [0..SUN4I_NDMA_NR_MAX_CHANNELS) are normal pchans, and
- * [SUN4I_NDMA_NR_MAX_CHANNELS..SUN4I_DMA_NR_MAX_CHANNELS) are
- * dedicated ones
- */
- for (i = 0; i < SUN4I_NDMA_NR_MAX_CHANNELS; i++)
- priv->pchans[i].base = priv->base +
- SUN4I_NDMA_CHANNEL_REG_BASE(i);
- for (j = 0; i < SUN4I_DMA_NR_MAX_CHANNELS; i++, j++) {
- priv->pchans[i].base = priv->base +
- SUN4I_DDMA_CHANNEL_REG_BASE(j);
- priv->pchans[i].is_dedicated = 1;
- }
- for (i = 0; i < SUN4I_DMA_NR_MAX_VCHANS; i++) {
- struct sun4i_dma_vchan *vchan = &priv->vchans[i];
- spin_lock_init(&vchan->vc.lock);
- vchan->vc.desc_free = sun4i_dma_free_contract;
- 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 + SUN4I_DMA_IRQ_ENABLE_REG);
- writel(0xFFFFFFFF, priv->base + SUN4I_DMA_IRQ_PENDING_STATUS_REG);
- ret = devm_request_irq(&pdev->dev, priv->irq, sun4i_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, sun4i_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 SUN4I_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 sun4i_dma_remove(struct platform_device *pdev)
- {
- struct sun4i_dma_dev *priv = platform_get_drvdata(pdev);
- /* Disable IRQ so no more work is scheduled */
- disable_irq(priv->irq);
- 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 sun4i_dma_match[] = {
- { .compatible = "allwinner,sun4i-a10-dma" },
- { /* sentinel */ },
- };
- MODULE_DEVICE_TABLE(of, sun4i_dma_match);
- static struct platform_driver sun4i_dma_driver = {
- .probe = sun4i_dma_probe,
- .remove = sun4i_dma_remove,
- .driver = {
- .name = "sun4i-dma",
- .of_match_table = sun4i_dma_match,
- },
- };
- module_platform_driver(sun4i_dma_driver);
- MODULE_DESCRIPTION("Allwinner A10 Dedicated DMA Controller Driver");
- MODULE_AUTHOR("Emilio López <emilio@elopez.com.ar>");
- MODULE_LICENSE("GPL");
|