Fedora kernel-2.6.17-1.2142_FC4 patched with stable patch-2.6.17.4-vs2.0.2-rc26.diff
[linux-2.6.git] / arch / sh / drivers / dma / dma-sh.c
index ec3ff50..cca26c4 100644 (file)
@@ -1,10 +1,11 @@
 /*
- * arch/sh/kernel/cpu/dma.c
+ * arch/sh/drivers/dma/dma-sh.c
  *
- * Copyright (C) 2000 Takashi YOSHII
- * Copyright (C) 2003 Paul Mundt
+ * SuperH On-chip DMAC Support
  *
- * PC like DMA API for SuperH's DMAC.
+ * Copyright (C) 2000 Takashi YOSHII
+ * Copyright (C) 2003, 2004 Paul Mundt
+ * Copyright (C) 2005 Andriy Skulysh
  *
  * This file is subject to the terms and conditions of the GNU General Public
  * License.  See the file "COPYING" in the main directory of this archive
 #include <linux/irq.h>
 #include <linux/interrupt.h>
 #include <linux/module.h>
+#include <asm/dreamcast/dma.h>
 #include <asm/signal.h>
 #include <asm/irq.h>
 #include <asm/dma.h>
 #include <asm/io.h>
 #include "dma-sh.h"
 
-/*
- * The SuperH DMAC supports a number of transmit sizes, we list them here,
- * with their respective values as they appear in the CHCR registers.
- *
- * Defaults to a 64-bit transfer size.
- */
-enum {
-       XMIT_SZ_64BIT   = 0,
-       XMIT_SZ_8BIT    = 1,
-       XMIT_SZ_16BIT   = 2,
-       XMIT_SZ_32BIT   = 3,
-       XMIT_SZ_256BIT  = 4,
-};
-
-/*
- * The DMA count is defined as the number of bytes to transfer.
- */
-static unsigned int ts_shift[] = {
-       [XMIT_SZ_64BIT]         3,
-       [XMIT_SZ_8BIT]          0,
-       [XMIT_SZ_16BIT]         1,
-       [XMIT_SZ_32BIT]         2,
-       [XMIT_SZ_256BIT]        5,
-};
-
-struct sh_dmac_channel {
-        unsigned long sar;
-        unsigned long dar;
-        unsigned long dmatcr;
-        unsigned long chcr;
-} __attribute__ ((aligned(16)));
-
-struct sh_dmac_info {
-        struct sh_dmac_channel channel[4];
-        unsigned long dmaor;
-};
-
-static volatile struct sh_dmac_info *sh_dmac = (volatile struct sh_dmac_info *)SH_DMAC_BASE;
-
 static inline unsigned int get_dmte_irq(unsigned int chan)
 {
-       unsigned int irq;
+       unsigned int irq = 0;
 
-       /* 
+       /*
         * Normally we could just do DMTE0_IRQ + chan outright, though in the
         * case of the 7751R, the DMTE IRQs for channels > 4 start right above
         * the SCIF
         */
-
        if (chan < 4) {
                irq = DMTE0_IRQ + chan;
        } else {
+#ifdef DMTE4_IRQ
                irq = DMTE4_IRQ + chan - 4;
+#endif
        }
 
        return irq;
@@ -84,13 +48,15 @@ static inline unsigned int get_dmte_irq(unsigned int chan)
  * We determine the correct shift size based off of the CHCR transmit size
  * for the given channel. Since we know that it will take:
  *
- *     info->count >> ts_shift[transmit_size]
+ *     info->count >> ts_shift[transmit_size]
  *
  * iterations to complete the transfer.
  */
-static inline unsigned int calc_xmit_shift(struct dma_info *info)
+static inline unsigned int calc_xmit_shift(struct dma_channel *chan)
 {
-       return ts_shift[(sh_dmac->channel[info->chan].chcr >> 4) & 0x0007];
+       u32 chcr = ctrl_inl(CHCR[chan->chan]);
+
+       return ts_shift[(chcr & CHCR_TS_MASK)>>CHCR_TS_SHIFT];
 }
 
 /*
@@ -101,68 +67,102 @@ static inline unsigned int calc_xmit_shift(struct dma_info *info)
  */
 static irqreturn_t dma_tei(int irq, void *dev_id, struct pt_regs *regs)
 {
-       struct dma_info * info = (struct dma_info *)dev_id;
-       u32 chcr = sh_dmac->channel[info->chan].chcr;
+       struct dma_channel *chan = (struct dma_channel *)dev_id;
+       u32 chcr;
+
+       chcr = ctrl_inl(CHCR[chan->chan]);
 
        if (!(chcr & CHCR_TE))
                return IRQ_NONE;
 
-       sh_dmac->channel[info->chan].chcr = chcr & ~(CHCR_IE | CHCR_DE);
+       chcr &= ~(CHCR_IE | CHCR_DE);
+       ctrl_outl(chcr, CHCR[chan->chan]);
 
-       wake_up(&info->wait_queue);
+       wake_up(&chan->wait_queue);
 
        return IRQ_HANDLED;
 }
 
-static int sh_dmac_request_dma(struct dma_info *info)
+static int sh_dmac_request_dma(struct dma_channel *chan)
 {
-       return request_irq(get_dmte_irq(info->chan), dma_tei,
-                          SA_INTERRUPT, "DMAC Transfer End", info);
+       char name[32];
+
+       snprintf(name, sizeof(name), "DMAC Transfer End (Channel %d)",
+                chan->chan);
+
+       return request_irq(get_dmte_irq(chan->chan), dma_tei,
+                          SA_INTERRUPT, name, chan);
 }
 
-static void sh_dmac_free_dma(struct dma_info *info)
+static void sh_dmac_free_dma(struct dma_channel *chan)
 {
-       free_irq(get_dmte_irq(info->chan), info);
+       free_irq(get_dmte_irq(chan->chan), chan);
 }
 
-static void sh_dmac_configure_channel(struct dma_info *info, unsigned long chcr)
+static void
+sh_dmac_configure_channel(struct dma_channel *chan, unsigned long chcr)
 {
        if (!chcr)
-               chcr = RS_DUAL;
+               chcr = RS_DUAL | CHCR_IE;
 
-       sh_dmac->channel[info->chan].chcr = chcr;
+       if (chcr & CHCR_IE) {
+               chcr &= ~CHCR_IE;
+               chan->flags |= DMA_TEI_CAPABLE;
+       } else {
+               chan->flags &= ~DMA_TEI_CAPABLE;
+       }
+
+       ctrl_outl(chcr, CHCR[chan->chan]);
 
-       info->configured = 1;
+       chan->flags |= DMA_CONFIGURED;
 }
 
-static void sh_dmac_enable_dma(struct dma_info *info)
+static void sh_dmac_enable_dma(struct dma_channel *chan)
 {
-       int irq = get_dmte_irq(info->chan);
+       int irq;
+       u32 chcr;
+
+       chcr = ctrl_inl(CHCR[chan->chan]);
+       chcr |= CHCR_DE;
+
+       if (chan->flags & DMA_TEI_CAPABLE)
+               chcr |= CHCR_IE;
+
+       ctrl_outl(chcr, CHCR[chan->chan]);
 
-       sh_dmac->channel[info->chan].chcr |= (CHCR_DE | CHCR_IE);
-       enable_irq(irq);
+       if (chan->flags & DMA_TEI_CAPABLE) {
+               irq = get_dmte_irq(chan->chan);
+               enable_irq(irq);
+       }
 }
 
-static void sh_dmac_disable_dma(struct dma_info *info)
+static void sh_dmac_disable_dma(struct dma_channel *chan)
 {
-       int irq = get_dmte_irq(info->chan);
+       int irq;
+       u32 chcr;
 
-       disable_irq(irq);
-       sh_dmac->channel[info->chan].chcr &= ~(CHCR_DE | CHCR_TE | CHCR_IE);
+       if (chan->flags & DMA_TEI_CAPABLE) {
+               irq = get_dmte_irq(chan->chan);
+               disable_irq(irq);
+       }
+
+       chcr = ctrl_inl(CHCR[chan->chan]);
+       chcr &= ~(CHCR_DE | CHCR_TE | CHCR_IE);
+       ctrl_outl(chcr, CHCR[chan->chan]);
 }
 
-static int sh_dmac_xfer_dma(struct dma_info *info)
+static int sh_dmac_xfer_dma(struct dma_channel *chan)
 {
-       /* 
+       /*
         * If we haven't pre-configured the channel with special flags, use
         * the defaults.
         */
-       if (!info->configured)
-               sh_dmac_configure_channel(info, 0);
+       if (unlikely(!(chan->flags & DMA_CONFIGURED)))
+               sh_dmac_configure_channel(chan, 0);
 
-       sh_dmac_disable_dma(info);
-       
-       /* 
+       sh_dmac_disable_dma(chan);
+
+       /*
         * Single-address mode usage note!
         *
         * It's important that we don't accidentally write any value to SAR/DAR
@@ -177,34 +177,60 @@ static int sh_dmac_xfer_dma(struct dma_info *info)
         * cascading to the PVR2 DMAC. In this case, we still need to write
         * SAR and DAR, regardless of value, in order for cascading to work.
         */
-       if (info->sar || (mach_is_dreamcast() && info->chan == 2))
-               sh_dmac->channel[info->chan].sar = info->sar;
-       if (info->dar || (mach_is_dreamcast() && info->chan == 2))
-               sh_dmac->channel[info->chan].dar = info->dar;
-       
-       sh_dmac->channel[info->chan].dmatcr = info->count >> calc_xmit_shift(info);
+       if (chan->sar || (mach_is_dreamcast() &&
+                         chan->chan == PVR2_CASCADE_CHAN))
+               ctrl_outl(chan->sar, SAR[chan->chan]);
+       if (chan->dar || (mach_is_dreamcast() &&
+                         chan->chan == PVR2_CASCADE_CHAN))
+               ctrl_outl(chan->dar, DAR[chan->chan]);
+
+       ctrl_outl(chan->count >> calc_xmit_shift(chan), DMATCR[chan->chan]);
 
-       sh_dmac_enable_dma(info);
+       sh_dmac_enable_dma(chan);
 
        return 0;
 }
 
-static int sh_dmac_get_dma_residue(struct dma_info *info)
+static int sh_dmac_get_dma_residue(struct dma_channel *chan)
 {
-       if (!(sh_dmac->channel[info->chan].chcr & CHCR_DE))
+       if (!(ctrl_inl(CHCR[chan->chan]) & CHCR_DE))
                return 0;
 
-       return sh_dmac->channel[info->chan].dmatcr << calc_xmit_shift(info);
+       return ctrl_inl(DMATCR[chan->chan]) << calc_xmit_shift(chan);
 }
 
-#if defined(CONFIG_CPU_SH4)
-static irqreturn_t dma_err(int irq, void *dev_id, struct pt_regs *regs)
+#ifdef CONFIG_CPU_SUBTYPE_SH7780
+#define dmaor_read_reg()       ctrl_inw(DMAOR)
+#define dmaor_write_reg(data)  ctrl_outw(data, DMAOR)
+#else
+#define dmaor_read_reg()       ctrl_inl(DMAOR)
+#define dmaor_write_reg(data)  ctrl_outl(data, DMAOR)
+#endif
+
+static inline int dmaor_reset(void)
 {
-       printk("DMAE: DMAOR=%lx\n", sh_dmac->dmaor);
+       unsigned long dmaor = dmaor_read_reg();
+
+       /* Try to clear the error flags first, incase they are set */
+       dmaor &= ~(DMAOR_NMIF | DMAOR_AE);
+       dmaor_write_reg(dmaor);
 
-       sh_dmac->dmaor &= ~(DMAOR_NMIF | DMAOR_AE);
-       sh_dmac->dmaor |= DMAOR_DME;
+       dmaor |= DMAOR_INIT;
+       dmaor_write_reg(dmaor);
 
+       /* See if we got an error again */
+       if ((dmaor_read_reg() & (DMAOR_AE | DMAOR_NMIF))) {
+               printk(KERN_ERR "dma-sh: Can't initialize DMAOR.\n");
+               return -EINVAL;
+       }
+
+       return 0;
+}
+
+#if defined(CONFIG_CPU_SH4)
+static irqreturn_t dma_err(int irq, void *dev_id, struct pt_regs *regs)
+{
+       dmaor_reset();
        disable_irq(irq);
 
        return IRQ_HANDLED;
@@ -212,16 +238,23 @@ static irqreturn_t dma_err(int irq, void *dev_id, struct pt_regs *regs)
 #endif
 
 static struct dma_ops sh_dmac_ops = {
-       .name           = "SuperH DMAC",
        .request        = sh_dmac_request_dma,
        .free           = sh_dmac_free_dma,
        .get_residue    = sh_dmac_get_dma_residue,
        .xfer           = sh_dmac_xfer_dma,
        .configure      = sh_dmac_configure_channel,
 };
-       
+
+static struct dma_info sh_dmac_info = {
+       .name           = "sh_dmac",
+       .nr_channels    = CONFIG_NR_ONCHIP_DMA_CHANNELS,
+       .ops            = &sh_dmac_ops,
+       .flags          = DMAC_CHANNELS_TEI_CAPABLE,
+};
+
 static int __init sh_dmac_init(void)
 {
+       struct dma_info *info = &sh_dmac_info;
        int i;
 
 #ifdef CONFIG_CPU_SH4
@@ -231,18 +264,21 @@ static int __init sh_dmac_init(void)
                return i;
 #endif
 
-       for (i = 0; i < MAX_DMAC_CHANNELS; i++) {
+       for (i = 0; i < info->nr_channels; i++) {
                int irq = get_dmte_irq(i);
 
                make_ipr_irq(irq, DMA_IPR_ADDR, DMA_IPR_POS, DMA_PRIORITY);
-
-               dma_info[i].ops = &sh_dmac_ops;
-               dma_info[i].tei_capable = 1;
        }
 
-       sh_dmac->dmaor |= 0x8000 | DMAOR_DME;
+       /*
+        * Initialize DMAOR, and clean up any error flags that may have
+        * been set.
+        */
+       i = dmaor_reset();
+       if (i < 0)
+               return i;
 
-       return register_dmac(&sh_dmac_ops);
+       return register_dmac(info);
 }
 
 static void __exit sh_dmac_exit(void)
@@ -250,10 +286,12 @@ static void __exit sh_dmac_exit(void)
 #ifdef CONFIG_CPU_SH4
        free_irq(DMAE_IRQ, 0);
 #endif
+       unregister_dmac(&sh_dmac_info);
 }
 
 subsys_initcall(sh_dmac_init);
 module_exit(sh_dmac_exit);
 
+MODULE_AUTHOR("Takashi YOSHII, Paul Mundt, Andriy Skulysh");
+MODULE_DESCRIPTION("SuperH On-Chip DMAC Support");
 MODULE_LICENSE("GPL");
-