/*
 * SA11x0 DMAengine support
 *
 * Copyright (C) 2012 Russell King
 *   Derived in part from arch/arm/mach-sa1100/dma.c,
 *   Copyright (C) 2000, 2001 by Nicolas Pitre
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */
#include <linux/sched.h>
#include <linux/device.h>
#include <linux/dmaengine.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/sa11x0-dma.h>
#include <linux/slab.h>
#include <linux/spinlock.h>

#include "virt-dma.h"

#define NR_PHY_CHAN     6
#define DMA_ALIGN       3
#define DMA_MAX_SIZE    0x1fff
#define DMA_CHUNK_SIZE  0x1000

#define DMA_DDAR        0x00
#define DMA_DCSR_S      0x04
#define DMA_DCSR_C      0x08
#define DMA_DCSR_R      0x0c
#define DMA_DBSA        0x10
#define DMA_DBTA        0x14
#define DMA_DBSB        0x18
#define DMA_DBTB        0x1c
#define DMA_SIZE        0x20

#define DCSR_RUN        (1 << 0)
#define DCSR_IE         (1 << 1)
#define DCSR_ERROR      (1 << 2)
#define DCSR_DONEA      (1 << 3)
#define DCSR_STRTA      (1 << 4)
#define DCSR_DONEB      (1 << 5)
#define DCSR_STRTB      (1 << 6)
#define DCSR_BIU        (1 << 7)

#define DDAR_RW         (1 << 0)        /* 0 = W, 1 = R */
#define DDAR_E          (1 << 1)        /* 0 = LE, 1 = BE */
#define DDAR_BS         (1 << 2)        /* 0 = BS4, 1 = BS8 */
#define DDAR_DW         (1 << 3)        /* 0 = 8b, 1 = 16b */
#define DDAR_Ser0UDCTr  (0x0 << 4)
#define DDAR_Ser0UDCRc  (0x1 << 4)
#define DDAR_Ser1SDLCTr (0x2 << 4)
#define DDAR_Ser1SDLCRc (0x3 << 4)
#define DDAR_Ser1UARTTr (0x4 << 4)
#define DDAR_Ser1UARTRc (0x5 << 4)
#define DDAR_Ser2ICPTr  (0x6 << 4)
#define DDAR_Ser2ICPRc  (0x7 << 4)
#define DDAR_Ser3UARTTr (0x8 << 4)
#define DDAR_Ser3UARTRc (0x9 << 4)
#define DDAR_Ser4MCP0Tr (0xa << 4)
#define DDAR_Ser4MCP0Rc (0xb << 4)
#define DDAR_Ser4MCP1Tr (0xc << 4)
#define DDAR_Ser4MCP1Rc (0xd << 4)
#define DDAR_Ser4SSPTr  (0xe << 4)
#define DDAR_Ser4SSPRc  (0xf << 4)

struct sa11x0_dma_sg {
        u32                     addr;
        u32                     len;
};

struct sa11x0_dma_desc {
        struct virt_dma_desc    vd;

        u32                     ddar;
        size_t                  size;
        unsigned                period;
        bool                    cyclic;

        unsigned                sglen;
        struct sa11x0_dma_sg    sg[0];
};

struct sa11x0_dma_phy;

struct sa11x0_dma_chan {
        struct virt_dma_chan    vc;

        /* protected by c->vc.lock */
        struct sa11x0_dma_phy   *phy;
        enum dma_status         status;

        /* protected by d->lock */
        struct list_head        node;

        u32                     ddar;
        const char              *name;
};

struct sa11x0_dma_phy {
        void __iomem            *base;
        struct sa11x0_dma_dev   *dev;
        unsigned                num;

        struct sa11x0_dma_chan  *vchan;

        /* Protected by c->vc.lock */
        unsigned                sg_load;
        struct sa11x0_dma_desc  *txd_load;
        unsigned                sg_done;
        struct sa11x0_dma_desc  *txd_done;
#ifdef CONFIG_PM_SLEEP
        u32                     dbs[2];
        u32                     dbt[2];
        u32                     dcsr;
#endif
};

struct sa11x0_dma_dev {
        struct dma_device       slave;
        void __iomem            *base;
        spinlock_t              lock;
        struct tasklet_struct   task;
        struct list_head        chan_pending;
        struct sa11x0_dma_phy   phy[NR_PHY_CHAN];
};

static struct sa11x0_dma_chan *to_sa11x0_dma_chan(struct dma_chan *chan)
{
        return container_of(chan, struct sa11x0_dma_chan, vc.chan);
}

static struct sa11x0_dma_dev *to_sa11x0_dma(struct dma_device *dmadev)
{
        return container_of(dmadev, struct sa11x0_dma_dev, slave);
}

static struct sa11x0_dma_desc *sa11x0_dma_next_desc(struct sa11x0_dma_chan *c)
{
        struct virt_dma_desc *vd = vchan_next_desc(&c->vc);

        return vd ? container_of(vd, struct sa11x0_dma_desc, vd) : NULL;
}

static void sa11x0_dma_free_desc(struct virt_dma_desc *vd)
{
        kfree(container_of(vd, struct sa11x0_dma_desc, vd));
}

static void sa11x0_dma_start_desc(struct sa11x0_dma_phy *p, struct sa11x0_dma_desc *txd)
{
        list_del(&txd->vd.node);
        p->txd_load = txd;
        p->sg_load = 0;

        dev_vdbg(p->dev->slave.dev, "pchan %u: txd %p[%x]: starting: DDAR:%x\n",
                p->num, &txd->vd, txd->vd.tx.cookie, txd->ddar);
}

static void noinline sa11x0_dma_start_sg(struct sa11x0_dma_phy *p,
        struct sa11x0_dma_chan *c)
{
        struct sa11x0_dma_desc *txd = p->txd_load;
        struct sa11x0_dma_sg *sg;
        void __iomem *base = p->base;
        unsigned dbsx, dbtx;
        u32 dcsr;

        if (!txd)
                return;

        dcsr = readl_relaxed(base + DMA_DCSR_R);

        /* Don't try to load the next transfer if both buffers are started */
        if ((dcsr & (DCSR_STRTA | DCSR_STRTB)) == (DCSR_STRTA | DCSR_STRTB))
                return;

        if (p->sg_load == txd->sglen) {
                if (!txd->cyclic) {
                        struct sa11x0_dma_desc *txn = sa11x0_dma_next_desc(c);

                        /*
                         * We have reached the end of the current descriptor.
                         * Peek at the next descriptor, and if compatible with
                         * the current, start processing it.
                         */
                        if (txn && txn->ddar == txd->ddar) {
                                txd = txn;
                                sa11x0_dma_start_desc(p, txn);
                        } else {
                                p->txd_load = NULL;
                                return;
                        }
                } else {
                        /* Cyclic: reset back to beginning */
                        p->sg_load = 0;
                }
        }

        sg = &txd->sg[p->sg_load++];

        /* Select buffer to load according to channel status */
        if (((dcsr & (DCSR_BIU | DCSR_STRTB)) == (DCSR_BIU | DCSR_STRTB)) ||
            ((dcsr & (DCSR_BIU | DCSR_STRTA)) == 0)) {
                dbsx = DMA_DBSA;
                dbtx = DMA_DBTA;
                dcsr = DCSR_STRTA | DCSR_IE | DCSR_RUN;
        } else {
                dbsx = DMA_DBSB;
                dbtx = DMA_DBTB;
                dcsr = DCSR_STRTB | DCSR_IE | DCSR_RUN;
        }

        writel_relaxed(sg->addr, base + dbsx);
        writel_relaxed(sg->len, base + dbtx);
        writel(dcsr, base + DMA_DCSR_S);

        dev_dbg(p->dev->slave.dev, "pchan %u: load: DCSR:%02x DBS%c:%08x DBT%c:%08x\n",
                p->num, dcsr,
                'A' + (dbsx == DMA_DBSB), sg->addr,
                'A' + (dbtx == DMA_DBTB), sg->len);
}

static void noinline sa11x0_dma_complete(struct sa11x0_dma_phy *p,
        struct sa11x0_dma_chan *c)
{
        struct sa11x0_dma_desc *txd = p->txd_done;

        if (++p->sg_done == txd->sglen) {
                if (!txd->cyclic) {
                        vchan_cookie_complete(&txd->vd);

                        p->sg_done = 0;
                        p->txd_done = p->txd_load;

                        if (!p->txd_done)
                                tasklet_schedule(&p->dev->task);
                } else {
                        if ((p->sg_done % txd->period) == 0)
                                vchan_cyclic_callback(&txd->vd);

                        /* Cyclic: reset back to beginning */
                        p->sg_done = 0;
                }
        }

        sa11x0_dma_start_sg(p, c);
}

static irqreturn_t sa11x0_dma_irq(int irq, void *dev_id)
{
        struct sa11x0_dma_phy *p = dev_id;
        struct sa11x0_dma_dev *d = p->dev;
        struct sa11x0_dma_chan *c;
        u32 dcsr;

        dcsr = readl_relaxed(p->base + DMA_DCSR_R);
        if (!(dcsr & (DCSR_ERROR | DCSR_DONEA | DCSR_DONEB)))
                return IRQ_NONE;

        /* Clear reported status bits */
        writel_relaxed(dcsr & (DCSR_ERROR | DCSR_DONEA | DCSR_DONEB),
                p->base + DMA_DCSR_C);

        dev_dbg(d->slave.dev, "pchan %u: irq: DCSR:%02x\n", p->num, dcsr);

        if (dcsr & DCSR_ERROR) {
                dev_err(d->slave.dev, "pchan %u: error. DCSR:%02x DDAR:%08x DBSA:%08x DBTA:%08x DBSB:%08x DBTB:%08x\n",
                        p->num, dcsr,
                        readl_relaxed(p->base + DMA_DDAR),
                        readl_relaxed(p->base + DMA_DBSA),
                        readl_relaxed(p->base + DMA_DBTA),
                        readl_relaxed(p->base + DMA_DBSB),
                        readl_relaxed(p->base + DMA_DBTB));
        }

        c = p->vchan;
        if (c) {
                unsigned long flags;

                spin_lock_irqsave(&c->vc.lock, flags);
                /*
                 * Now that we're holding the lock, check that the vchan
                 * really is associated with this pchan before touching the
                 * hardware.  This should always succeed, because we won't
                 * change p->vchan or c->phy while the channel is actively
                 * transferring.
                 */
                if (c->phy == p) {
                        if (dcsr & DCSR_DONEA)
                                sa11x0_dma_complete(p, c);
                        if (dcsr & DCSR_DONEB)
                                sa11x0_dma_complete(p, c);
                }
                spin_unlock_irqrestore(&c->vc.lock, flags);
        }

        return IRQ_HANDLED;
}

static void sa11x0_dma_start_txd(struct sa11x0_dma_chan *c)
{
        struct sa11x0_dma_desc *txd = sa11x0_dma_next_desc(c);

        /* If the issued list is empty, we have no further txds to process */
        if (txd) {
                struct sa11x0_dma_phy *p = c->phy;

                sa11x0_dma_start_desc(p, txd);
                p->txd_done = txd;
                p->sg_done = 0;

                /* The channel should not have any transfers started */
                WARN_ON(readl_relaxed(p->base + DMA_DCSR_R) &
                                      (DCSR_STRTA | DCSR_STRTB));

                /* Clear the run and start bits before changing DDAR */
                writel_relaxed(DCSR_RUN | DCSR_STRTA | DCSR_STRTB,
                               p->base + DMA_DCSR_C);
                writel_relaxed(txd->ddar, p->base + DMA_DDAR);

                /* Try to start both buffers */
                sa11x0_dma_start_sg(p, c);
                sa11x0_dma_start_sg(p, c);
        }
}

static void sa11x0_dma_tasklet(unsigned long arg)
{
        struct sa11x0_dma_dev *d = (struct sa11x0_dma_dev *)arg;
        struct sa11x0_dma_phy *p;
        struct sa11x0_dma_chan *c;
        unsigned pch, pch_alloc = 0;

        dev_dbg(d->slave.dev, "tasklet enter\n");

        list_for_each_entry(c, &d->slave.channels, vc.chan.device_node) {
                spin_lock_irq(&c->vc.lock);
                p = c->phy;
                if (p && !p->txd_done) {
                        sa11x0_dma_start_txd(c);
                        if (!p->txd_done) {
                                /* No current txd associated with this channel */
                                dev_dbg(d->slave.dev, "pchan %u: free\n", p->num);

                                /* Mark this channel free */
                                c->phy = NULL;
                                p->vchan = NULL;
                        }
                }
                spin_unlock_irq(&c->vc.lock);
        }

        spin_lock_irq(&d->lock);
        for (pch = 0; pch < NR_PHY_CHAN; pch++) {
                p = &d->phy[pch];

                if (p->vchan == NULL && !list_empty(&d->chan_pending)) {
                        c = list_first_entry(&d->chan_pending,
                                struct sa11x0_dma_chan, node);
                        list_del_init(&c->node);

                        pch_alloc |= 1 << pch;

                        /* Mark this channel allocated */
                        p->vchan = c;

                        dev_dbg(d->slave.dev, "pchan %u: alloc vchan %p\n", pch, &c->vc);
                }
        }
        spin_unlock_irq(&d->lock);

        for (pch = 0; pch < NR_PHY_CHAN; pch++) {
                if (pch_alloc & (1 << pch)) {
                        p = &d->phy[pch];
                        c = p->vchan;

                        spin_lock_irq(&c->vc.lock);
                        c->phy = p;

                        sa11x0_dma_start_txd(c);
                        spin_unlock_irq(&c->vc.lock);
                }
        }

        dev_dbg(d->slave.dev, "tasklet exit\n");
}


static int sa11x0_dma_alloc_chan_resources(struct dma_chan *chan)
{
        return 0;
}

static void sa11x0_dma_free_chan_resources(struct dma_chan *chan)
{
        struct sa11x0_dma_chan *c = to_sa11x0_dma_chan(chan);
        struct sa11x0_dma_dev *d = to_sa11x0_dma(chan->device);
        unsigned long flags;

        spin_lock_irqsave(&d->lock, flags);
        list_del_init(&c->node);
        spin_unlock_irqrestore(&d->lock, flags);

        vchan_free_chan_resources(&c->vc);
}

static dma_addr_t sa11x0_dma_pos(struct sa11x0_dma_phy *p)
{
        unsigned reg;
        u32 dcsr;

        dcsr = readl_relaxed(p->base + DMA_DCSR_R);

        if ((dcsr & (DCSR_BIU | DCSR_STRTA)) == DCSR_STRTA ||
            (dcsr & (DCSR_BIU | DCSR_STRTB)) == DCSR_BIU)
                reg = DMA_DBSA;
        else
                reg = DMA_DBSB;

        return readl_relaxed(p->base + reg);
}

static enum dma_status sa11x0_dma_tx_status(struct dma_chan *chan,
        dma_cookie_t cookie, struct dma_tx_state *state)
{
        struct sa11x0_dma_chan *c = to_sa11x0_dma_chan(chan);
        struct sa11x0_dma_dev *d = to_sa11x0_dma(chan->device);
        struct sa11x0_dma_phy *p;
        struct virt_dma_desc *vd;
        unsigned long flags;
        enum dma_status ret;

        ret = dma_cookie_status(&c->vc.chan, cookie, state);
        if (ret == DMA_SUCCESS)
                return ret;

        if (!state)
                return c->status;

        spin_lock_irqsave(&c->vc.lock, flags);
        p = c->phy;

        /*
         * If the cookie is on our issue queue, then the residue is
         * its total size.
         */
        vd = vchan_find_desc(&c->vc, cookie);
        if (vd) {
                state->residue = container_of(vd, struct sa11x0_dma_desc, vd)->size;
        } else if (!p) {
                state->residue = 0;
        } else {
                struct sa11x0_dma_desc *txd;
                size_t bytes = 0;

                if (p->txd_done && p->txd_done->vd.tx.cookie == cookie)
                        txd = p->txd_done;
                else if (p->txd_load && p->txd_load->vd.tx.cookie == cookie)
                        txd = p->txd_load;
                else
                        txd = NULL;

                ret = c->status;
                if (txd) {
                        dma_addr_t addr = sa11x0_dma_pos(p);
                        unsigned i;

                        dev_vdbg(d->slave.dev, "tx_status: addr:%x\n", addr);

                        for (i = 0; i < txd->sglen; i++) {
                                dev_vdbg(d->slave.dev, "tx_status: [%u] %x+%x\n",
                                        i, txd->sg[i].addr, txd->sg[i].len);
                                if (addr >= txd->sg[i].addr &&
                                    addr < txd->sg[i].addr + txd->sg[i].len) {
                                        unsigned len;

                                        len = txd->sg[i].len -
                                                (addr - txd->sg[i].addr);
                                        dev_vdbg(d->slave.dev, "tx_status: [%u] +%x\n",
                                                i, len);
                                        bytes += len;
                                        i++;
                                        break;
                                }
                        }
                        for (; i < txd->sglen; i++) {
                                dev_vdbg(d->slave.dev, "tx_status: [%u] %x+%x ++\n",
                                        i, txd->sg[i].addr, txd->sg[i].len);
                                bytes += txd->sg[i].len;
                        }
                }
                state->residue = bytes;
        }
        spin_unlock_irqrestore(&c->vc.lock, flags);

        dev_vdbg(d->slave.dev, "tx_status: bytes 0x%zx\n", state->residue);

        return ret;
}

/*
 * Move pending txds to the issued list, and re-init pending list.
 * If not already pending, add this channel to the list of pending
 * channels and trigger the tasklet to run.
 */
static void sa11x0_dma_issue_pending(struct dma_chan *chan)
{
        struct sa11x0_dma_chan *c = to_sa11x0_dma_chan(chan);
        struct sa11x0_dma_dev *d = to_sa11x0_dma(chan->device);
        unsigned long flags;

        spin_lock_irqsave(&c->vc.lock, flags);
        if (vchan_issue_pending(&c->vc)) {
                if (!c->phy) {
                        spin_lock(&d->lock);
                        if (list_empty(&c->node)) {
                                list_add_tail(&c->node, &d->chan_pending);
                                tasklet_schedule(&d->task);
                                dev_dbg(d->slave.dev, "vchan %p: issued\n", &c->vc);
                        }
                        spin_unlock(&d->lock);
                }
        } else
                dev_dbg(d->slave.dev, "vchan %p: nothing to issue\n", &c->vc);
        spin_unlock_irqrestore(&c->vc.lock, flags);
}

static struct dma_async_tx_descriptor *sa11x0_dma_prep_slave_sg(
        struct dma_chan *chan, struct scatterlist *sg, unsigned int sglen,
        enum dma_transfer_direction dir, unsigned long flags, void *context)
{
        struct sa11x0_dma_chan *c = to_sa11x0_dma_chan(chan);
        struct sa11x0_dma_desc *txd;
        struct scatterlist *sgent;
        unsigned i, j = sglen;
        size_t size = 0;

        /* SA11x0 channels can only operate in their native direction */
        if (dir != (c->ddar & DDAR_RW ? DMA_DEV_TO_MEM : DMA_MEM_TO_DEV)) {
                dev_err(chan->device->dev, "vchan %p: bad DMA direction: DDAR:%08x dir:%u\n",
                        &c->vc, c->ddar, dir);
                return NULL;
        }

        /* Do not allow zero-sized txds */
        if (sglen == 0)
                return NULL;

        for_each_sg(sg, sgent, sglen, i) {
                dma_addr_t addr = sg_dma_address(sgent);
                unsigned int len = sg_dma_len(sgent);

                if (len > DMA_MAX_SIZE)
                        j += DIV_ROUND_UP(len, DMA_MAX_SIZE & ~DMA_ALIGN) - 1;
                if (addr & DMA_ALIGN) {
                        dev_dbg(chan->device->dev, "vchan %p: bad buffer alignment: %08x\n",
                                &c->vc, addr);
                        return NULL;
                }
        }

        txd = kzalloc(sizeof(*txd) + j * sizeof(txd->sg[0]), GFP_ATOMIC);
        if (!txd) {
                dev_dbg(chan->device->dev, "vchan %p: kzalloc failed\n", &c->vc);
                return NULL;
        }

        j = 0;
        for_each_sg(sg, sgent, sglen, i) {
                dma_addr_t addr = sg_dma_address(sgent);
                unsigned len = sg_dma_len(sgent);

                size += len;

                do {
                        unsigned tlen = len;

                        /*
                         * Check whether the transfer will fit.  If not, try
                         * to split the transfer up such that we end up with
                         * equal chunks - but make sure that we preserve the
                         * alignment.  This avoids small segments.
                         */
                        if (tlen > DMA_MAX_SIZE) {
                                unsigned mult = DIV_ROUND_UP(tlen,
                                        DMA_MAX_SIZE & ~DMA_ALIGN);

                                tlen = (tlen / mult) & ~DMA_ALIGN;
                        }

                        txd->sg[j].addr = addr;
                        txd->sg[j].len = tlen;

                        addr += tlen;
                        len -= tlen;
                        j++;
                } while (len);
        }

        txd->ddar = c->ddar;
        txd->size = size;
        txd->sglen = j;

        dev_dbg(chan->device->dev, "vchan %p: txd %p: size %u nr %u\n",
                &c->vc, &txd->vd, txd->size, txd->sglen);

        return vchan_tx_prep(&c->vc, &txd->vd, flags);
}

static struct dma_async_tx_descriptor *sa11x0_dma_prep_dma_cyclic(
        struct dma_chan *chan, dma_addr_t addr, size_t size, size_t period,
        enum dma_transfer_direction dir, unsigned long flags, void *context)
{
        struct sa11x0_dma_chan *c = to_sa11x0_dma_chan(chan);
        struct sa11x0_dma_desc *txd;
        unsigned i, j, k, sglen, sgperiod;

        /* SA11x0 channels can only operate in their native direction */
        if (dir != (c->ddar & DDAR_RW ? DMA_DEV_TO_MEM : DMA_MEM_TO_DEV)) {
                dev_err(chan->device->dev, "vchan %p: bad DMA direction: DDAR:%08x dir:%u\n",
                        &c->vc, c->ddar, dir);
                return NULL;
        }

        sgperiod = DIV_ROUND_UP(period, DMA_MAX_SIZE & ~DMA_ALIGN);
        sglen = size * sgperiod / period;

        /* Do not allow zero-sized txds */
        if (sglen == 0)
                return NULL;

        txd = kzalloc(sizeof(*txd) + sglen * sizeof(txd->sg[0]), GFP_ATOMIC);
        if (!txd) {
                dev_dbg(chan->device->dev, "vchan %p: kzalloc failed\n", &c->vc);
                return NULL;
        }

        for (i = k = 0; i < size / period; i++) {
                size_t tlen, len = period;

                for (j = 0; j < sgperiod; j++, k++) {
                        tlen = len;

                        if (tlen > DMA_MAX_SIZE) {
                                unsigned mult = DIV_ROUND_UP(tlen, DMA_MAX_SIZE & ~DMA_ALIGN);
                                tlen = (tlen / mult) & ~DMA_ALIGN;
                        }

                        txd->sg[k].addr = addr;
                        txd->sg[k].len = tlen;
                        addr += tlen;
                        len -= tlen;
                }

                WARN_ON(len != 0);
        }

        WARN_ON(k != sglen);

        txd->ddar = c->ddar;
        txd->size = size;
        txd->sglen = sglen;
        txd->cyclic = 1;
        txd->period = sgperiod;

        return vchan_tx_prep(&c->vc, &txd->vd, DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
}

static int sa11x0_dma_slave_config(struct sa11x0_dma_chan *c, struct dma_slave_config *cfg)
{
        u32 ddar = c->ddar & ((0xf << 4) | DDAR_RW);
        dma_addr_t addr;
        enum dma_slave_buswidth width;
        u32 maxburst;

        if (ddar & DDAR_RW) {
                addr = cfg->src_addr;
                width = cfg->src_addr_width;
                maxburst = cfg->src_maxburst;
        } else {
                addr = cfg->dst_addr;
                width = cfg->dst_addr_width;
                maxburst = cfg->dst_maxburst;
        }

        if ((width != DMA_SLAVE_BUSWIDTH_1_BYTE &&
             width != DMA_SLAVE_BUSWIDTH_2_BYTES) ||
            (maxburst != 4 && maxburst != 8))
                return -EINVAL;

        if (width == DMA_SLAVE_BUSWIDTH_2_BYTES)
                ddar |= DDAR_DW;
        if (maxburst == 8)
                ddar |= DDAR_BS;

        dev_dbg(c->vc.chan.device->dev, "vchan %p: dma_slave_config addr %x width %u burst %u\n",
                &c->vc, addr, width, maxburst);

        c->ddar = ddar | (addr & 0xf0000000) | (addr & 0x003ffffc) << 6;

        return 0;
}

static int sa11x0_dma_control(struct dma_chan *chan, enum dma_ctrl_cmd cmd,
        unsigned long arg)
{
        struct sa11x0_dma_chan *c = to_sa11x0_dma_chan(chan);
        struct sa11x0_dma_dev *d = to_sa11x0_dma(chan->device);
        struct sa11x0_dma_phy *p;
        LIST_HEAD(head);
        unsigned long flags;
        int ret;

        switch (cmd) {
        case DMA_SLAVE_CONFIG:
                return sa11x0_dma_slave_config(c, (struct dma_slave_config *)arg);

        case DMA_TERMINATE_ALL:
                dev_dbg(d->slave.dev, "vchan %p: terminate all\n", &c->vc);
                /* Clear the tx descriptor lists */
                spin_lock_irqsave(&c->vc.lock, flags);
                vchan_get_all_descriptors(&c->vc, &head);

                p = c->phy;
                if (p) {
                        dev_dbg(d->slave.dev, "pchan %u: terminating\n", p->num);
                        /* vchan is assigned to a pchan - stop the channel */
                        writel(DCSR_RUN | DCSR_IE |
                                DCSR_STRTA | DCSR_DONEA |
                                DCSR_STRTB | DCSR_DONEB,
                                p->base + DMA_DCSR_C);

                        if (p->txd_load) {
                                if (p->txd_load != p->txd_done)
                                        list_add_tail(&p->txd_load->vd.node, &head);
                                p->txd_load = NULL;
                        }
                        if (p->txd_done) {
                                list_add_tail(&p->txd_done->vd.node, &head);
                                p->txd_done = NULL;
                        }
                        c->phy = NULL;
                        spin_lock(&d->lock);
                        p->vchan = NULL;
                        spin_unlock(&d->lock);
                        tasklet_schedule(&d->task);
                }
                spin_unlock_irqrestore(&c->vc.lock, flags);
                vchan_dma_desc_free_list(&c->vc, &head);
                ret = 0;
                break;

        case DMA_PAUSE:
                dev_dbg(d->slave.dev, "vchan %p: pause\n", &c->vc);
                spin_lock_irqsave(&c->vc.lock, flags);
                if (c->status == DMA_IN_PROGRESS) {
                        c->status = DMA_PAUSED;

                        p = c->phy;
                        if (p) {
                                writel(DCSR_RUN | DCSR_IE, p->base + DMA_DCSR_C);
                        } else {
                                spin_lock(&d->lock);
                                list_del_init(&c->node);
                                spin_unlock(&d->lock);
                        }
                }
                spin_unlock_irqrestore(&c->vc.lock, flags);
                ret = 0;
                break;

        case DMA_RESUME:
                dev_dbg(d->slave.dev, "vchan %p: resume\n", &c->vc);
                spin_lock_irqsave(&c->vc.lock, flags);
                if (c->status == DMA_PAUSED) {
                        c->status = DMA_IN_PROGRESS;

                        p = c->phy;
                        if (p) {
                                writel(DCSR_RUN | DCSR_IE, p->base + DMA_DCSR_S);
                        } else if (!list_empty(&c->vc.desc_issued)) {
                                spin_lock(&d->lock);
                                list_add_tail(&c->node, &d->chan_pending);
                                spin_unlock(&d->lock);
                        }
                }
                spin_unlock_irqrestore(&c->vc.lock, flags);
                ret = 0;
                break;

        default:
                ret = -ENXIO;
                break;
        }

        return ret;
}

struct sa11x0_dma_channel_desc {
        u32 ddar;
        const char *name;
};

#define CD(d1, d2) { .ddar = DDAR_##d1 | d2, .name = #d1 }
static const struct sa11x0_dma_channel_desc chan_desc[] = {
        CD(Ser0UDCTr, 0),
        CD(Ser0UDCRc, DDAR_RW),
        CD(Ser1SDLCTr, 0),
        CD(Ser1SDLCRc, DDAR_RW),
        CD(Ser1UARTTr, 0),
        CD(Ser1UARTRc, DDAR_RW),
        CD(Ser2ICPTr, 0),
        CD(Ser2ICPRc, DDAR_RW),
        CD(Ser3UARTTr, 0),
        CD(Ser3UARTRc, DDAR_RW),
        CD(Ser4MCP0Tr, 0),
        CD(Ser4MCP0Rc, DDAR_RW),
        CD(Ser4MCP1Tr, 0),
        CD(Ser4MCP1Rc, DDAR_RW),
        CD(Ser4SSPTr, 0),
        CD(Ser4SSPRc, DDAR_RW),
};

static int __devinit sa11x0_dma_init_dmadev(struct dma_device *dmadev,
        struct device *dev)
{
        unsigned i;

        dmadev->chancnt = ARRAY_SIZE(chan_desc);
        INIT_LIST_HEAD(&dmadev->channels);
        dmadev->dev = dev;
        dmadev->device_alloc_chan_resources = sa11x0_dma_alloc_chan_resources;
        dmadev->device_free_chan_resources = sa11x0_dma_free_chan_resources;
        dmadev->device_control = sa11x0_dma_control;
        dmadev->device_tx_status = sa11x0_dma_tx_status;
        dmadev->device_issue_pending = sa11x0_dma_issue_pending;

        for (i = 0; i < dmadev->chancnt; i++) {
                struct sa11x0_dma_chan *c;

                c = kzalloc(sizeof(*c), GFP_KERNEL);
                if (!c) {
                        dev_err(dev, "no memory for channel %u\n", i);
                        return -ENOMEM;
                }

                c->status = DMA_IN_PROGRESS;
                c->ddar = chan_desc[i].ddar;
                c->name = chan_desc[i].name;
                INIT_LIST_HEAD(&c->node);

                c->vc.desc_free = sa11x0_dma_free_desc;
                vchan_init(&c->vc, dmadev);
        }

        return dma_async_device_register(dmadev);
}

static int sa11x0_dma_request_irq(struct platform_device *pdev, int nr,
        void *data)
{
        int irq = platform_get_irq(pdev, nr);

        if (irq <= 0)
                return -ENXIO;

        return request_irq(irq, sa11x0_dma_irq, 0, dev_name(&pdev->dev), data);
}

static void sa11x0_dma_free_irq(struct platform_device *pdev, int nr,
        void *data)
{
        int irq = platform_get_irq(pdev, nr);
        if (irq > 0)
                free_irq(irq, data);
}

static void sa11x0_dma_free_channels(struct dma_device *dmadev)
{
        struct sa11x0_dma_chan *c, *cn;

        list_for_each_entry_safe(c, cn, &dmadev->channels, vc.chan.device_node) {
                list_del(&c->vc.chan.device_node);
                tasklet_kill(&c->vc.task);
                kfree(c);
        }
}

static int __devinit sa11x0_dma_probe(struct platform_device *pdev)
{
        struct sa11x0_dma_dev *d;
        struct resource *res;
        unsigned i;
        int ret;

        res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
        if (!res)
                return -ENXIO;

        d = kzalloc(sizeof(*d), GFP_KERNEL);
        if (!d) {
                ret = -ENOMEM;
                goto err_alloc;
        }

        spin_lock_init(&d->lock);
        INIT_LIST_HEAD(&d->chan_pending);

        d->base = ioremap(res->start, resource_size(res));
        if (!d->base) {
                ret = -ENOMEM;
                goto err_ioremap;
        }

        tasklet_init(&d->task, sa11x0_dma_tasklet, (unsigned long)d);

        for (i = 0; i < NR_PHY_CHAN; i++) {
                struct sa11x0_dma_phy *p = &d->phy[i];

                p->dev = d;
                p->num = i;
                p->base = d->base + i * DMA_SIZE;
                writel_relaxed(DCSR_RUN | DCSR_IE | DCSR_ERROR |
                        DCSR_DONEA | DCSR_STRTA | DCSR_DONEB | DCSR_STRTB,
                        p->base + DMA_DCSR_C);
                writel_relaxed(0, p->base + DMA_DDAR);

                ret = sa11x0_dma_request_irq(pdev, i, p);
                if (ret) {
                        while (i) {
                                i--;
                                sa11x0_dma_free_irq(pdev, i, &d->phy[i]);
                        }
                        goto err_irq;
                }
        }

        dma_cap_set(DMA_SLAVE, d->slave.cap_mask);
        dma_cap_set(DMA_CYCLIC, d->slave.cap_mask);
        d->slave.device_prep_slave_sg = sa11x0_dma_prep_slave_sg;
        d->slave.device_prep_dma_cyclic = sa11x0_dma_prep_dma_cyclic;
        ret = sa11x0_dma_init_dmadev(&d->slave, &pdev->dev);
        if (ret) {
                dev_warn(d->slave.dev, "failed to register slave async device: %d\n",
                        ret);
                goto err_slave_reg;
        }

        platform_set_drvdata(pdev, d);
        return 0;

 err_slave_reg:
        sa11x0_dma_free_channels(&d->slave);
        for (i = 0; i < NR_PHY_CHAN; i++)
                sa11x0_dma_free_irq(pdev, i, &d->phy[i]);
 err_irq:
        tasklet_kill(&d->task);
        iounmap(d->base);
 err_ioremap:
        kfree(d);
 err_alloc:
        return ret;
}

static int __devexit sa11x0_dma_remove(struct platform_device *pdev)
{
        struct sa11x0_dma_dev *d = platform_get_drvdata(pdev);
        unsigned pch;

        dma_async_device_unregister(&d->slave);

        sa11x0_dma_free_channels(&d->slave);
        for (pch = 0; pch < NR_PHY_CHAN; pch++)
                sa11x0_dma_free_irq(pdev, pch, &d->phy[pch]);
        tasklet_kill(&d->task);
        iounmap(d->base);
        kfree(d);

        return 0;
}

#ifdef CONFIG_PM_SLEEP
static int sa11x0_dma_suspend(struct device *dev)
{
        struct sa11x0_dma_dev *d = dev_get_drvdata(dev);
        unsigned pch;

        for (pch = 0; pch < NR_PHY_CHAN; pch++) {
                struct sa11x0_dma_phy *p = &d->phy[pch];
                u32 dcsr, saved_dcsr;

                dcsr = saved_dcsr = readl_relaxed(p->base + DMA_DCSR_R);
                if (dcsr & DCSR_RUN) {
                        writel(DCSR_RUN | DCSR_IE, p->base + DMA_DCSR_C);
                        dcsr = readl_relaxed(p->base + DMA_DCSR_R);

                }

                saved_dcsr &= DCSR_RUN | DCSR_IE;
                if (dcsr & DCSR_BIU) {
                        p->dbs[0] = readl_relaxed(p->base + DMA_DBSB);
                        p->dbt[0] = readl_relaxed(p->base + DMA_DBTB);
                        p->dbs[1] = readl_relaxed(p->base + DMA_DBSA);
                        p->dbt[1] = readl_relaxed(p->base + DMA_DBTA);
                        saved_dcsr |= (dcsr & DCSR_STRTA ? DCSR_STRTB : 0) |
                                      (dcsr & DCSR_STRTB ? DCSR_STRTA : 0);
                } else {
                        p->dbs[0] = readl_relaxed(p->base + DMA_DBSA);
                        p->dbt[0] = readl_relaxed(p->base + DMA_DBTA);
                        p->dbs[1] = readl_relaxed(p->base + DMA_DBSB);
                        p->dbt[1] = readl_relaxed(p->base + DMA_DBTB);
                        saved_dcsr |= dcsr & (DCSR_STRTA | DCSR_STRTB);
                }
                p->dcsr = saved_dcsr;

                writel(DCSR_STRTA | DCSR_STRTB, p->base + DMA_DCSR_C);
        }

        return 0;
}

static int sa11x0_dma_resume(struct device *dev)
{
        struct sa11x0_dma_dev *d = dev_get_drvdata(dev);
        unsigned pch;

        for (pch = 0; pch < NR_PHY_CHAN; pch++) {
                struct sa11x0_dma_phy *p = &d->phy[pch];
                struct sa11x0_dma_desc *txd = NULL;
                u32 dcsr = readl_relaxed(p->base + DMA_DCSR_R);

                WARN_ON(dcsr & (DCSR_BIU | DCSR_STRTA | DCSR_STRTB | DCSR_RUN));

                if (p->txd_done)
                        txd = p->txd_done;
                else if (p->txd_load)
                        txd = p->txd_load;

                if (!txd)
                        continue;

                writel_relaxed(txd->ddar, p->base + DMA_DDAR);

                writel_relaxed(p->dbs[0], p->base + DMA_DBSA);
                writel_relaxed(p->dbt[0], p->base + DMA_DBTA);
                writel_relaxed(p->dbs[1], p->base + DMA_DBSB);
                writel_relaxed(p->dbt[1], p->base + DMA_DBTB);
                writel_relaxed(p->dcsr, p->base + DMA_DCSR_S);
        }

        return 0;
}
#endif

static const struct dev_pm_ops sa11x0_dma_pm_ops = {
        .suspend_noirq = sa11x0_dma_suspend,
        .resume_noirq = sa11x0_dma_resume,
        .freeze_noirq = sa11x0_dma_suspend,
        .thaw_noirq = sa11x0_dma_resume,
        .poweroff_noirq = sa11x0_dma_suspend,
        .restore_noirq = sa11x0_dma_resume,
};

static struct platform_driver sa11x0_dma_driver = {
        .driver = {
                .name   = "sa11x0-dma",
                .owner  = THIS_MODULE,
                .pm     = &sa11x0_dma_pm_ops,
        },
        .probe          = sa11x0_dma_probe,
        .remove         = __devexit_p(sa11x0_dma_remove),
};

bool sa11x0_dma_filter_fn(struct dma_chan *chan, void *param)
{
        if (chan->device->dev->driver == &sa11x0_dma_driver.driver) {
                struct sa11x0_dma_chan *c = to_sa11x0_dma_chan(chan);
                const char *p = param;

                return !strcmp(c->name, p);
        }
        return false;
}
EXPORT_SYMBOL(sa11x0_dma_filter_fn);

static int __init sa11x0_dma_init(void)
{
        return platform_driver_register(&sa11x0_dma_driver);
}
subsys_initcall(sa11x0_dma_init);

static void __exit sa11x0_dma_exit(void)
{
        platform_driver_unregister(&sa11x0_dma_driver);
}
module_exit(sa11x0_dma_exit);

MODULE_AUTHOR("Russell King");
MODULE_DESCRIPTION("SA-11x0 DMA driver");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:sa11x0-dma");