patch-2.1.96 linux/arch/arm/kernel/dma-arc.c

• Lines: 116
• Date: Sun Apr 12 11:42:15 1998
• Orig file: v2.1.95/linux/arch/arm/kernel/dma-arc.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.1.95/linux/arch/arm/kernel/dma-arc.c linux/arch/arm/kernel/dma-arc.c
@@ -0,0 +1,115 @@
+/*
+ * arch/arm/kernel/dma-arc.c
+ *
+ * Copyright (C) 1998 Dave Gilbert / Russell King
+ *
+ * DMA functions specific to Archimedes architecture
+ */
+#include <linux/sched.h>
+#include <linux/init.h>
+
+#include <asm/dma.h>
+#include <asm/io.h>
+#include <asm/hardware.h>
+
+#include "dma.h"
+
+int arch_request_dma(dmach_t channel, dma_t *dma)
+{
+	if (channel == DMA_VIRTUAL_FLOPPY0 ||
+	    channel == DMA_VIRTUAL_FLOPPY1)
+		return 0;
+	else
+		return -EINVAL;
+}
+
+void arch_free_dma(dmach_t channel, dma_t *dma)
+{
+	if (channel != DMA_VIRTUAL_FLOPPY0 &&
+	    channel != DMA_VIRTUAL_FLOPPY1)
+		return 0;
+	else
+		return -EINVAL;
+}
+
+void arch_enable_dma(dmach_t channel, dma_t *dma)
+{
+	switch (channel) {
+	case DMA_VIRTUAL_FLOPPY0: { /* Data DMA */
+		switch (dma->dma_mode) {
+		case DMA_MODE_READ: /* read */
+    	    	{
+			extern unsigned char fdc1772_dma_read, fdc1772_dma_read_end;
+			extern void fdc1772_setupdma(unsigned int count,unsigned int addr);
+			unsigned long flags;
+#ifdef DEBUG
+			printk("enable_dma fdc1772 data read\n");
+#endif
+			save_flags(flags);
+			cliIF();
+			
+			memcpy ((void *)0x1c, (void *)&fdc1772_dma_read,
+				&fdc1772_dma_read_end - &fdc1772_dma_read);
+			fdc1772_setupdma(dma->buf.length, __bus_to_virt(dma->buf.address)); /* Sets data pointer up */
+			enable_irq (64);
+			restore_flags(flags);
+		}
+		break;
+
+		case DMA_MODE_WRITE: /* write */
+	        {
+			extern unsigned char fdc1772_dma_write, fdc1772_dma_write_end;
+			extern void fdc1772_setupdma(unsigned int count,unsigned int addr);
+			unsigned long flags;
+
+#ifdef DEBUG
+			printk("enable_dma fdc1772 data write\n");
+#endif
+			save_flags(flags);
+			cliIF();
+			memcpy ((void *)0x1c, (void *)&fdc1772_dma_write,
+				&fdc1772_dma_write_end - &fdc1772_dma_write);
+			fdc1772_setupdma(dma->buf.length, __bus_to_virt(dma->buf.address)); /* Sets data pointer up */
+			enable_irq (64);
+
+			restore_flags(flags);
+		}
+		break;
+    		default:
+			printk ("enable_dma: dma%d not initialised\n", channel);
+			return;
+		}
+	}
+	break;
+
+	case DMA_VIRTUAL_FLOPPY1: { /* Command end FIQ - actually just sets a flag */
+		/* Need to build a branch at the FIQ address */
+		extern void fdc1772_comendhandler(void);
+		unsigned long flags;
+
+		/*printk("enable_dma fdc1772 command end FIQ\n");*/
+		save_flags(flags);
+		cliIF();
+	
+		*((unsigned int *)0x1c)=0xea000000 | (((unsigned int)fdc1772_comendhandler-(0x1c+8))/4); /* B fdc1772_comendhandler */
+
+		restore_flags(flags);
+	}
+	break;
+	}
+}
+
+void arch_disable_dma(dmach_t channel, dma_t *dma)
+{
+	if (channel != DMA_VIRTUAL_FLOPPY0 &&
+	    channel != DMA_VIRTUAL_FLOPPY1)
+		printk("arch_disable_dma: invalid channel %d\n", channel);
+	else
+		disable_irq(dma->dma_irq);
+}
+
+__initfunc(void arch_dma_init(dma_t *dma))
+{
+	dma[DMA_VIRTUAL_FLOPPY0].dma_irq = 64;
+	dma[DMA_VIRTUAL_FLOPPY1].dma_irq = 65;
+}