1 files changed, 76 insertions, 0 deletions
diff --git a/arch/arm/kernel/io.c b/arch/arm/kernel/io.c
new file mode 100644
index 00000000..ba8f0559
--- /dev/null
+++ b/arch/arm/kernel/io.c
@@ -0,0 +1,76 @@
+#include <linux/export.h>
+#include <linux/types.h>
+#include <linux/io.h>
+
+/*
+ * Copy data from IO memory space to "real" memory space.
+ * This needs to be optimized.
+ */
+void _memcpy_fromio(void *to, const volatile void __iomem *from, size_t count)
+{
+	unsigned char *t = to;
+	while (count) {
+		count--;
+		*t = readb(from);
+		t++;
+		from++;
+	}
+}
+
+/*
+ * Copy data from "real" memory space to IO memory space.
+ * This needs to be optimized.
+ */
+void _memcpy_toio(volatile void __iomem *to, const void *from, size_t count)
+{
+	/*const unsigned char *f = from;
+	while (count) {
+		count--;
+		writeb(*f, to);
+		f++;
+		to++;
+	}*/
+	/*Dannierchen update for 4 byte data memory cpy*/
+	void *vdest = (void __force *) to;
+	
+	//__asm__ __volatile__ ("sync" : : : "memory");
+	while(count && ((((unsigned long)vdest)&3) || (((unsigned long)from)&3))) {
+		*((volatile u8 *)vdest) = *((u8 *)from);
+		from++;
+		vdest++;
+		count--;
+		/*printk("start sf_write(vdest:0x%x, from:0x%x )\n", vdest, from);*/
+	}
+	while(count >= 4) {
+		*((volatile u32 *)vdest) = *((volatile u32 *)from);
+		from += 4;
+		vdest += 4;
+		count-=4;
+	}
+	while(count) {
+		*((volatile u8 *)vdest) = *((u8 *)from);
+		from++;
+		vdest++;
+		count--;
+		/*printk("end sf_write(vdest:0x%x, from:0x%x )\n", vdest, from);*/
+	}
+	//__asm__ __volatile__ ("sync" : : : "memory");
+
+}
+
+/*
+ * "memset" on IO memory space.
+ * This needs to be optimized.
+ */
+void _memset_io(volatile void __iomem *dst, int c, size_t count)
+{
+	while (count) {
+		count--;
+		writeb(c, dst);
+		dst++;
+	}
+}
+
+EXPORT_SYMBOL(_memcpy_fromio);
+EXPORT_SYMBOL(_memcpy_toio);
+EXPORT_SYMBOL(_memset_io);