openwrt-xburst/target/linux/storm/patches/001-arch.patch

--- a/arch/arm/Kconfig
+++ b/arch/arm/Kconfig
@@ -220,6 +220,9 @@ config ARCH_EP93XX
 	help
 	  This enables support for the Cirrus EP93xx series of CPUs.
 
+config ARCH_SL2312
+    bool "SL2312"
+
 config ARCH_FOOTBRIDGE
 	bool "FootBridge"
 	select FOOTBRIDGE
@@ -414,6 +417,8 @@ source "arch/arm/mach-ep93xx/Kconfig"
 
 source "arch/arm/mach-footbridge/Kconfig"
 
+source "arch/arm/mach-sl2312/Kconfig"
+
 source "arch/arm/mach-integrator/Kconfig"
 
 source "arch/arm/mach-iop32x/Kconfig"
@@ -549,6 +554,16 @@ config PCI
 config PCI_SYSCALL
 	def_bool PCI
 
+config SL2312_LPC
+    bool "LPC Host Support"
+    depends on ARCH_SL2312
+    help
+
+config SL2312_LPC_IT8712
+    bool "IT8712 Support"
+    depends on ARCH_SL2312 && SL2312_LPC
+    help
+
 # Select the host bridge type
 config PCI_HOST_VIA82C505
 	bool
@@ -988,6 +1003,10 @@ if ALIGNMENT_TRAP || !CPU_CP15_MMU
 source "drivers/mtd/Kconfig"
 endif
 
+if ARCH_SL2312
+source "drivers/telephony/Kconfig"
+endif
+
 source "drivers/parport/Kconfig"
 
 source "drivers/pnp/Kconfig"
@@ -997,7 +1016,7 @@ source "drivers/block/Kconfig"
 if PCMCIA || ARCH_CLPS7500 || ARCH_IOP32X || ARCH_IOP33X || ARCH_IXP4XX \
 	|| ARCH_L7200 || ARCH_LH7A40X || ARCH_PXA || ARCH_RPC \
 	|| ARCH_S3C2410 || ARCH_SA1100 || ARCH_SHARK || FOOTBRIDGE \
-	|| ARCH_IXP23XX
+	|| ARCH_IXP23XX || ARCH_SL2312
 source "drivers/ide/Kconfig"
 endif
 
--- a/arch/arm/Makefile
+++ b/arch/arm/Makefile
@@ -72,6 +72,7 @@ tune-$(CONFIG_CPU_ARM920T)	:=-mtune=arm9
 tune-$(CONFIG_CPU_ARM922T)	:=-mtune=arm9tdmi
 tune-$(CONFIG_CPU_ARM925T)	:=-mtune=arm9tdmi
 tune-$(CONFIG_CPU_ARM926T)	:=-mtune=arm9tdmi
+tune-$(CONFIG_CPU_FA52X)    :=-mtune=arm9tdmi
 tune-$(CONFIG_CPU_SA110)	:=-mtune=strongarm110
 tune-$(CONFIG_CPU_SA1100)	:=-mtune=strongarm1100
 tune-$(CONFIG_CPU_XSCALE)	:=$(call cc-option,-mtune=xscale,-mtune=strongarm110) -Wa,-mcpu=xscale
@@ -111,6 +112,7 @@ endif
  machine-$(CONFIG_ARCH_PXA)	   := pxa
  machine-$(CONFIG_ARCH_L7200)	   := l7200
  machine-$(CONFIG_ARCH_INTEGRATOR) := integrator
+ machine-$(CONFIG_ARCH_SL2312)     := sl2312
  textofs-$(CONFIG_ARCH_CLPS711X)   := 0x00028000
  machine-$(CONFIG_ARCH_CLPS711X)   := clps711x
  machine-$(CONFIG_ARCH_IOP32X)	   := iop32x
--- a/arch/arm/boot/compressed/Makefile
+++ b/arch/arm/boot/compressed/Makefile
@@ -19,6 +19,10 @@ ifeq ($(CONFIG_ARCH_SHARK),y)
 OBJS		+= head-shark.o ofw-shark.o
 endif
 
+ifeq ($(CONFIG_ARCH_SL2312),y)
+OBJS		+= head-sl2312.o
+endif
+
 ifeq ($(CONFIG_ARCH_L7200),y)
 OBJS		+= head-l7200.o
 endif
--- /dev/null
+++ b/arch/arm/boot/compressed/head-sl2312.S
@@ -0,0 +1,6 @@
+#include <asm/mach-types.h>
+#include <asm/arch/sl2312.h>
+
+		.section	".start", "ax"
+		mov	r7, #MACH_TYPE_SL2312
+
--- a/arch/arm/boot/compressed/head.S
+++ b/arch/arm/boot/compressed/head.S
@@ -57,6 +57,17 @@
 		mov	\rb, #0x50000000
 		add	\rb, \rb, #0x4000 * CONFIG_S3C_LOWLEVEL_UART_PORT
 		.endm
+/*****************************************************
+ *      for Storlink SoC
+ *****************************************************/
+#elif defined(CONFIG_ARCH_SL2312)
+		.macro	loadsp, rb
+		mov	\rb, #0x16000000
+		.endm
+		.macro	writeb, rb
+		strb	\rb, [r3, #0]
+		.endm
+/****************************************************/
 #else
 		.macro	loadsp,	rb
 		addruart \rb
@@ -116,7 +127,28 @@ start:
 		.rept	8
 		mov	r0, r0
 		.endr
-
+/*****************************************************************************
+ *  for Storlink Soc -- on chip UART
+ *****************************************************************************/
+#ifndef CONFIG_SERIAL_IT8712		// Jason test
+@                mov     r3, #0x22000000
+                mov     r3, #0x42000000
+                mov     r11, #0x80
+                strb    r11, [r3, #0xc]
+                mov     r11, #0x0
+                strb    r11, [r3, #0x4]
+#ifndef CONFIG_SL3516_ASIC
+                mov     r11, #0x9C		/*0x9c->19200 0x4E->38400 0x34->57600 */
+#else
+		mov 	r11, #0x9C		/* 0x61 for 30MHz on GeminiA chip*/
+#endif
+                strb    r11, [r3, #0x0]
+                mov     r11, #0x03
+                strb    r11, [r3, #0xc]
+		        mov     r11, #0xFB
+                strb    r11, [r3, #0x18]
+#endif
+/*****************************************************************************/
 		b	1f
 		.word	0x016f2818		@ Magic numbers to help the loader
 		.word	start			@ absolute load/run zImage address
@@ -458,6 +490,39 @@ __armv7_mmu_cache_on:
 		mcr	p15, 0, r0, c7, c5, 4	@ ISB
 		mov	pc, r12
 
+/*****************************************************************************
+ *  for Storlink Soc -- CPU cache
+ *****************************************************************************/
+__fa526_cache_on:
+                mov     r12, lr
+                bl      __setup_mmu
+                mov     r0, #0
+                mcr     p15, 0, r0, c7, c6, 0   @ Invalidate D cache
+                mcr     p15, 0, r0, c7, c5, 0   @ Invalidate I cache
+                mcr     p15, 0, r0, c7, c10, 4  @ drain write buffer
+                mcr     p15, 0, r0, c8, c7, 0   @ flush I,D TLBs
+                mcr     p15, 0, r3, c2, c0, 0   @ load page table pointer
+                mov     r0, #-1
+                mcr     p15, 0, r0, c3, c0, 0   @ load domain access register
+                mrc     p15, 0, r0, c1, c0, 0
+                mov     r0, r0
+                mov     r0, r0
+#ifndef CONFIG_CPU_DCACHE_DISABLE
+        orr     r0, r0, #0x0004                 @ .... .... .... .1..
+#endif
+#ifndef CONFIG_CPU_ICACHE_DISABLE
+        orr     r0, r0, #0x1000                 @ ...1 .... .... ....
+#endif
+
+#ifndef DEBUG
+                orr     r0, r0, #0x0039         @ Write buffer, mmu
+#endif
+                mcr     p15, 0, r0, c1, c0
+                mov     r0, r0
+                mov     r0, r0
+                mov     pc, r12
+/********************************************************************************/
+
 __arm6_mmu_cache_on:
 		mov	r12, lr
 		bl	__setup_mmu
@@ -625,6 +690,16 @@ proc_types:
 
 		@ These match on the architecture ID
 
+/*****************************************************************************
+ *  for Storlink Soc -- CPU architecture ID
+ *****************************************************************************/
+        .word   0x66015261              @ FA526
+        .word   0xff01fff1
+        b       __fa526_cache_on
+        b       __fa526_cache_off
+        b       __fa526_cache_flush
+/*****************************************************************************/
+
 		.word	0x00020000		@ ARMv4T
 		.word	0x000f0000
 		b	__armv4_mmu_cache_on
@@ -712,6 +787,23 @@ __armv7_mmu_cache_off:
 		mcr	p15, 0, r0, c8, c7, 0	@ invalidate whole TLB
 		mov	pc, r12
 
+/*****************************************************************************
+ *  for Storlink Soc -- CPU cache
+ *****************************************************************************/
+__fa526_cache_off:
+        mrc     p15, 0, r0, c1, c0
+        bic     r0, r0, #0x000d
+        mov     r1, #0
+        mcr     p15, 0, r1, c7, c14, 0  @ clean and invalidate D cache
+        mcr     p15, 0, r1, c7, c10, 4  @ drain WB
+        mcr     p15, 0, r0, c1, c0      @ turn MMU and cache off
+        mov     r0, #0
+        mcr     p15, 0, r0, c7, c5, 0   @ invalidate whole cache v4
+        mcr     p15, 0, r0, c8, c7, 0   @ invalidate whole TLB v4
+        mov     pc, lr
+/*****************************************************************************/
+
+
 __arm6_mmu_cache_off:
 		mov	r0, #0x00000030		@ ARM6 control reg.
 		b	__armv3_mmu_cache_off
@@ -759,6 +851,17 @@ __armv4_mpu_cache_flush:
 		mcr	p15, 0, ip, c7, c10, 4	@ drain WB
 		mov	pc, lr
 		
+/*****************************************************************************
+ *  for Storlink Soc -- CPU cache
+ *****************************************************************************/
+__fa526_cache_flush:
+                mov     r1, #0
+                mcr     p15, 0, r1, c7, c14, 0  @ clean and invalidate D cache
+                mcr     p15, 0, r1, c7, c5, 0   @ flush I cache
+                mcr     p15, 0, r1, c7, c10, 4  @ drain WB
+                mov     pc, lr
+/*****************************************************************************/
+
 
 __armv6_mmu_cache_flush:
 		mov	r1, #0
--- /dev/null
+++ b/arch/arm/boot/compressed/it8712.h
@@ -0,0 +1,25 @@
+
+#ifndef __IT8712_H__
+#define __IT8712_H__
+
+#include "asm/arch/sl2312.h"
+
+#define IT8712_IO_BASE			SL2312_LPC_IO_BASE
+//#define IT8712_IO_BASE			0x27000000
+// Device LDN
+#define LDN_SERIAL1				0x01
+#define LDN_SERIAL2				0x02
+#define LDN_PARALLEL			0x03
+#define LDN_KEYBOARD			0x05
+#define LDN_MOUSE				0x06
+#define LDN_GPIO				0x07
+
+#define IT8712_UART1_PORT      	0x3F8
+#define IT8712_UART2_PORT      	0x2F8
+
+#define IT8712_GPIO_BASE		0x800	// 0x800-0x804 for GPIO set1-set5
+
+void LPCSetConfig(char LdnNumber, char Index, char data);
+char LPCGetConfig(char LdnNumber, char Index);
+
+#endif
--- a/arch/arm/boot/compressed/misc.c
+++ b/arch/arm/boot/compressed/misc.c
@@ -30,7 +30,7 @@ static void putstr(const char *ptr);
 #include <asm/arch/uncompress.h>
 
 #ifdef CONFIG_DEBUG_ICEDCC
-
+#include "it8712.h"
 #ifdef CONFIG_CPU_V6
 
 static void icedcc_putc(int ch)
@@ -69,6 +69,7 @@ static void icedcc_putc(int ch)
 #define flush()	do { } while (0)
 #endif
 
+#if 0
 static void putstr(const char *ptr)
 {
 	char c;
@@ -81,11 +82,36 @@ static void putstr(const char *ptr)
 
 	flush();
 }
+#endif
 
 #endif
 
 #define __ptr_t void *
 
+#ifdef CONFIG_SERIAL_IT8712
+unsigned int it8712_uart_base;
+#define UART_RX         0
+#define UART_TX         0
+#define UART_DLL        0
+#define UART_TRG        0
+#define UART_DLM        1
+#define UART_IER        1
+#define UART_FCTR       1
+#define UART_IIR        2
+#define UART_FCR        2
+#define UART_EFR        2
+#define UART_LCR        3
+#define UART_MCR        4
+#define UART_LSR        5
+#define UART_MSR        6
+#define UART_SCR        7
+#define UART_EMSR       7
+void LPCEnterMBPnP(void);
+void LPCExitMBPnP(void);
+int SearchIT8712(void);
+int InitLPCInterface(void);
+#endif
+
 /*
  * Optimised C version of memzero for the ARM.
  */
@@ -346,6 +372,9 @@ ulg
 decompress_kernel(ulg output_start, ulg free_mem_ptr_p, ulg free_mem_ptr_end_p,
 		  int arch_id)
 {
+#ifdef CONFIG_SERIAL_IT8712
+        unsigned char *addr;
+#endif
 	output_data		= (uch *)output_start;	/* Points to kernel start */
 	free_mem_ptr		= free_mem_ptr_p;
 	free_mem_ptr_end	= free_mem_ptr_end_p;
@@ -353,6 +382,33 @@ decompress_kernel(ulg output_start, ulg 
 
 	arch_decomp_setup();
 
+#ifdef CONFIG_SERIAL_IT8712
+
+        InitLPCInterface();
+        LPCSetConfig(0, 0x02, 0x01);
+        LPCSetConfig(LDN_SERIAL1, 0x30, 0x1);
+        LPCSetConfig(LDN_SERIAL1, 0x23, 0x0);
+        it8712_uart_base = IT8712_IO_BASE;
+        it8712_uart_base += ((LPCGetConfig(LDN_SERIAL1, 0x60) << 8) + LPCGetConfig(LDN_SERIAL1, 0x61));
+
+        do {
+        addr = (unsigned char *)(it8712_uart_base + UART_LCR) ;
+        *addr = 0x80;
+        // Set Baud Rate
+        addr = (unsigned char *)(it8712_uart_base+UART_DLL);
+        *addr = 0x06 ;
+        addr = (unsigned char *)(it8712_uart_base+UART_DLM);
+        *addr = 0x00 ;
+
+        addr = (unsigned char *)(it8712_uart_base+UART_LCR);    // LCR
+        *addr = 0x07 ;
+        addr = (unsigned char *)(it8712_uart_base+UART_MCR);    // MCR
+        *addr = 0x08 ;
+        addr = (unsigned char *)(it8712_uart_base+UART_FCR);    // FCR
+        *addr = 0x01 ;
+    	} while(0);
+#endif
+
 	makecrc();
 	putstr("Uncompressing Linux...");
 	gunzip();
@@ -374,4 +430,119 @@ int main()
 	return 0;
 }
 #endif
+
+#ifdef CONFIG_SERIAL_IT8712
+
+#define LPC_KEY_ADDR    (unsigned char *)(SL2312_LPC_IO_BASE + 0x2e)
+#define LPC_DATA_ADDR   (unsigned char *)(SL2312_LPC_IO_BASE + 0x2f)
+#define LPC_BUS_CTRL                    *( unsigned char*) (SL2312_LPC_HOST_BASE + 0)
+#define LPC_BUS_STATUS                  *( unsigned char*) (SL2312_LPC_HOST_BASE + 2)
+#define LPC_SERIAL_IRQ_CTRL             *( unsigned char*) (SL2312_LPC_HOST_BASE + 4)
+
+char LPCGetConfig(char LdnNumber, char Index)
+{
+        char rtn;
+        unsigned char *addr ;
+
+        LPCEnterMBPnP();                                // Enter IT8712 MB PnP mode
+
+        addr = LPC_KEY_ADDR;
+        *addr = 0x07 ;
+
+        addr = LPC_DATA_ADDR;
+        *addr = LdnNumber ;
+
+        addr = LPC_KEY_ADDR;
+        *addr = Index ;
+
+        addr = LPC_DATA_ADDR ;
+        rtn = *addr ;
+
+        LPCExitMBPnP();
+        return rtn;
+
+}
+
+void LPCSetConfig(char LdnNumber, char Index, char data)
+{
+        unsigned char *addr;
+        LPCEnterMBPnP();                                // Enter IT8712 MB PnP mode
+        addr = LPC_KEY_ADDR;
+        *addr = 0x07;
+        addr = LPC_DATA_ADDR;
+        *addr = LdnNumber;
+        addr = LPC_KEY_ADDR;
+        *addr = Index;
+        addr = LPC_DATA_ADDR;
+        *addr = data;
+
+        LPCExitMBPnP();
+}
+
+//unsigned char key[4] ;
+void LPCEnterMBPnP(void)
+{
+        unsigned char *addr;
+        addr = LPC_KEY_ADDR;
+        unsigned char key[4] = {0x87, 0x01, 0x55, 0x55};
+
+ 		do {
+ 		*addr = key[0];
+ 		*addr = key[1];
+ 		*addr = key[2];
+ 		*addr = key[3];
+ 		}while(0);
+}
+
+void LPCExitMBPnP(void)
+{
+        unsigned char *addr;
+        addr = LPC_KEY_ADDR;
+        *addr = 0x02 ;
+
+        addr = LPC_DATA_ADDR;
+        *addr = 0x02 ;
+}
+
+int InitLPCInterface(void)
+{
+        int i;
+        LPC_BUS_CTRL = 0xc0;
+        LPC_SERIAL_IRQ_CTRL = 0xc0;
+
+        for(i=0;i<0x2000;i++) ;
+
+        LPC_SERIAL_IRQ_CTRL = 0x80;
+        if (!SearchIT8712()) ;
+//			while(1);
+        return 0;
+}
+
+int SearchIT8712(void)
+{
+        unsigned char Id1, Id2;
+        unsigned short Id;
+        unsigned char *addr;
+
+        LPCEnterMBPnP();
+        addr = LPC_KEY_ADDR;
+        *addr = 0x20 ;
+        addr = LPC_DATA_ADDR;
+        Id1 = *addr ;
+
+        addr = LPC_KEY_ADDR;
+        *addr = 0x21 ;
+        addr = LPC_DATA_ADDR;
+        Id2 = *addr ;
+
+        Id = (Id1 << 8) | Id2;
+        LPCExitMBPnP();
+
+        if (Id == 0x8712)
+                return 1;
+        else
+                return 0;
+}
+
+#endif
 	
--- a/arch/arm/kernel/entry-armv.S
+++ b/arch/arm/kernel/entry-armv.S
@@ -18,6 +18,8 @@
 #include <asm/memory.h>
 #include <asm/glue.h>
 #include <asm/vfpmacros.h>
+#include <asm/arch/irqs.h>
+#include <asm/hardware.h>
 #include <asm/arch/entry-macro.S>
 #include <asm/thread_notify.h>
 
--- a/arch/arm/kernel/irq.c
+++ b/arch/arm/kernel/irq.c
@@ -40,6 +40,8 @@
 #include <asm/system.h>
 #include <asm/mach/time.h>
 
+extern int fixup_irq(unsigned int irq);
+
 /*
  * No architecture-specific irq_finish function defined in arm/arch/irqs.h.
  */
@@ -111,8 +113,11 @@ static struct irq_desc bad_irq_desc = {
 asmlinkage void __exception asm_do_IRQ(unsigned int irq, struct pt_regs *regs)
 {
 	struct pt_regs *old_regs = set_irq_regs(regs);
-	struct irq_desc *desc = irq_desc + irq;
+//	struct irq_desc *desc = irq_desc + irq;
+	struct irq_desc *desc;
 
+	irq = fixup_irq(irq);
+	desc = irq_desc + irq;
 	/*
 	 * Some hardware gives randomly wrong interrupts.  Rather
 	 * than crashing, do something sensible.
--- a/arch/arm/kernel/process.c
+++ b/arch/arm/kernel/process.c
@@ -117,7 +117,7 @@ void arm_machine_restart(char mode)
 void (*pm_idle)(void);
 EXPORT_SYMBOL(pm_idle);
 
-void (*pm_power_off)(void);
+//void (*pm_power_off)(void);
 EXPORT_SYMBOL(pm_power_off);
 
 void (*arm_pm_restart)(char str) = arm_machine_restart;
@@ -188,13 +188,37 @@ __setup("reboot=", reboot_setup);
 
 void machine_halt(void)
 {
+	unsigned int reg_v;
+
+	printk("arch_power_off\n");
+
+	reg_v = readl(IO_ADDRESS(SL2312_POWER_CTRL_BASE) + 0x04);
+	reg_v &= ~0x00000002;
+	reg_v |= 0x1;
+	mdelay(5);
+	// Power off
+	__raw_writel( reg_v, IO_ADDRESS(SL2312_POWER_CTRL_BASE) + 0x04);
+
 }
 
 
 void machine_power_off(void)
 {
-	if (pm_power_off)
+	unsigned int reg_v;
+
+//	if (pm_power_off)
+	if (&pm_power_off!=NULL)
 		pm_power_off();
+
+	printk("arch_power_off\n");
+
+	reg_v = readl(IO_ADDRESS(SL2312_POWER_CTRL_BASE) + 0x04);
+	reg_v &= ~0x00000002;
+	reg_v |= 0x1;
+	mdelay(5);
+	// Power off
+	__raw_writel( reg_v, IO_ADDRESS(SL2312_POWER_CTRL_BASE) + 0x04);
+
 }
 
 void machine_restart(char * __unused)
--- a/arch/arm/kernel/time.c
+++ b/arch/arm/kernel/time.c
@@ -502,8 +502,13 @@ static int __init timer_init_sysfs(void)
 
 device_initcall(timer_init_sysfs);
 
+extern unsigned int rtc_get_time_second(void);
+
 void __init time_init(void)
 {
+#ifdef CONFIG_SL2312_RTC
+	xtime.tv_sec  = rtc_get_time_second() ;
+#endif
 #ifndef CONFIG_GENERIC_TIME
 	if (system_timer->offset == NULL)
 		system_timer->offset = dummy_gettimeoffset;
--- /dev/null
+++ b/arch/arm/mach-sl2312/Kconfig
@@ -0,0 +1,33 @@
+
+menu "SL2312"
+
+config SL3516_ASIC
+	bool "SL3516 ASIC version"
+	depends on ARCH_SL2312
+	help
+	  This option to select AISC or FPGA
+config PCI
+       bool "SL2312 PCI"
+       depends on ARCH_SL2312
+       help
+         This option to enable Storlink PCI controller
+
+config SL2312_LPC
+       bool "SL2312 LPC"
+       depends on ARCH_SL2312
+       help
+         This option to enable Low Pin Count controller
+
+config SL2312_USB
+       bool "SL2312 USB"
+       depends on ARCH_SL2312
+       help
+         This option to enable USB OTG host controller
+
+config GEMINI_IPI
+       bool "Gemini IPI test"
+       depends on ARCH_SL2312
+       help
+	 Enable this option to test dual cpu Inter-Processor-Interrupt
+endmenu
+
--- /dev/null
+++ b/arch/arm/mach-sl2312/Makefile
@@ -0,0 +1,16 @@
+#
+# Makefile for the linux kernel.
+#
+
+# Object file lists.
+
+obj-y			:= arch.o irq.o mm.o time.o sl3516_device.o
+obj-m			:=
+obj-n			:=
+
+
+obj-$(CONFIG_PCI) += pci.o
+obj-$(CONFIG_SL2312_LPC) += lpc.o
+obj-$(CONFIG_SL2312_USB) += sl2312-otg.o # sl2312-otg-1.o
+obj-$(CONFIG_GEMINI_XOR_ACCE) += xor.o
+obj-$(CONFIG_GEMINI_IPI)      += gemini_ipi.o
--- /dev/null
+++ b/arch/arm/mach-sl2312/Makefile.boot
@@ -0,0 +1,5 @@
+   zreladdr-y	:= 0x00008000
+params_phys-y	:= 0x00508100
+#params_phys-y	:= 0x00008100
+initrd_phys-y	:= 0x00800000
+
--- /dev/null
+++ b/arch/arm/mach-sl2312/arch.c
@@ -0,0 +1,72 @@
+/*
+ *  linux/arch/arm/mach-epxa10db/arch.c
+ *
+ *  Copyright (C) 2000 Deep Blue Solutions Ltd
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#include <linux/types.h>
+#include <linux/init.h>
+
+#include <asm/hardware.h>
+#include <asm/setup.h>
+#include <asm/mach-types.h>
+#include <asm/mach/time.h>
+#include <asm/mach/arch.h>
+
+extern void sl2312_map_io(void);
+extern void sl2312_init_irq(void);
+extern unsigned long sl2312_gettimeoffset (void);
+extern void __init sl2312_time_init(void);
+
+static struct sys_timer sl2312_timer = {
+	.init		= sl2312_time_init,
+	.offset		= sl2312_gettimeoffset,
+};
+
+static void __init
+sl2312_fixup(struct machine_desc *desc, struct tag *tags,
+                 char **cmdline, struct meminfo *mi)
+{
+        mi->nr_banks      = 1;
+        mi->bank[0].start = 0;
+#ifdef CONFIG_GEMINI_IPI
+        mi->bank[0].size  = (64*1024*1024);  // 128M
+#else
+        mi->bank[0].size  = (128*1024*1024);  // 128M
+#endif
+        mi->bank[0].node  = 0;
+}
+
+/* MACHINE_START(SL2312, "GeminiA")
+	MAINTAINER("Storlink Semi")
+	BOOT_MEM(0x00000000, 0x90000000, 0xf0000000)
+        FIXUP(sl2312_fixup)
+	MAPIO(sl2312_map_io)
+	INITIRQ(sl2312_init_irq)
+	.timer = &sl2312_timer,
+MACHINE_END */
+
+MACHINE_START(SL2312, "GeminiA")
+	/* .phys_ram	= 0x00000000, */
+	.phys_io	= 0x7fffc000,
+	.io_pg_offst	= ((0xffffc000) >> 18) & 0xfffc,
+	.boot_params	= 0x100,
+	.fixup      = sl2312_fixup,
+	.map_io		= sl2312_map_io,
+	.init_irq	= sl2312_init_irq,
+	.timer		= &sl2312_timer,
+MACHINE_END
--- /dev/null
+++ b/arch/arm/mach-sl2312/gemini_ipi.c
@@ -0,0 +1,593 @@
+/*
+ * FILE NAME sl_cir.c
+ *
+ * BRIEF MODULE DESCRIPTION
+ *  IPI Driver for CPU1.
+ *
+ *  Author: StorLink, Corp.
+ *          Jason Lee
+ *
+ * Copyright 2002~2006 StorLink, Corp.
+ *
+ *  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.
+ *
+ *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
+ *  WARRANTIES,   INCLUDING, BUT NOT  LIMit8712D  TO, THE IMPLIED WARRANTIES OF
+ *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
+ *  NO  EVENT  SHALL   THE AUTHOR  BE	LIABLE FOR ANY   DIRECT, INDIRECT,
+ *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ *  NOT LIMit8712D   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
+ *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
+ *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
+ *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ *
+ *  You should have received a copy of the  GNU General Public License along
+ *  with this program; if not, writ8712  to the Free Software Foundation, Inc.,
+ *  675 Mass Ave, Cambridge, MA 02139, USA.
+ */
+
+#include <linux/module.h>
+#include <linux/types.h>
+#include <linux/kernel.h>
+#include <linux/miscdevice.h>
+#include <linux/init.h>
+#include <linux/pagemap.h>
+#include <asm/uaccess.h>
+#include <linux/ioport.h>
+#include <linux/sched.h>
+#include <linux/delay.h>
+#include <linux/fs.h>
+#include <linux/interrupt.h>
+#include <asm/io.h>
+#include <asm/delay.h>
+#include <linux/signal.h>
+#include <asm/arch/sl2312.h>
+#include <asm/arch/int_ctrl.h>
+#include <asm/arch/ipi.h>
+#include <linux/dma-mapping.h>
+
+
+#include <linux/mm.h>
+
+#include <linux/bootmem.h>
+
+#include <asm/hardware.h>
+#include <asm/page.h>
+#include <asm/setup.h>
+#include <asm/pgtable.h>
+#include <asm/pgalloc.h>
+
+#include <asm/mach/map.h>
+
+
+static int sl_ipi_debug = 1 ;
+#define DEB(x)  if(sl_ipi_debug>=1) x
+
+#define SRAM_PTR		IO_ADDRESS(SL2312_SRAM_BASE)
+volatile JSCALE_REQ_T *req=(JSCALE_REQ_T*)SRAM_PTR;
+volatile JSCALE_RSP_T *rsp=(JSCALE_RSP_T*)(SRAM_PTR+0x20);
+
+unsigned int jscale_status=0;
+
+#define JSCALE_WAIT	0
+#define XXXXXX_WAIT	1
+#define MAX_WAIT_Q	8
+wait_queue_head_t gemini_ipi_wait[MAX_WAIT_Q];
+
+#define DRAMCTL_DMA_CTL		0X20
+#define DRAMCTL_DMA_SA		0X24
+#define DRAMCTL_DMA_DA		0X28
+#define DRAMCTL_DMA_CNT		0X2C
+#define MEMCPY_UNIT		0x40000
+int hw_memcpy(const void *to, const void *from, unsigned int bytes)
+{
+	unsigned int reg_a,reg_d;
+	int count = bytes,i=0;
+
+	consistent_sync((unsigned int *)to, bytes, DMA_BIDIRECTIONAL);
+	consistent_sync((unsigned int *)from,bytes, DMA_TO_DEVICE);
+
+	DEB(printk("hwmemcpy:count %d\n",count));
+	while(count>0){
+		// SA
+		reg_a = IO_ADDRESS(SL2312_DRAM_CTRL_BASE)+DRAMCTL_DMA_SA;
+		reg_d = (unsigned int )__virt_to_phys(from) + i*MEMCPY_UNIT;
+		DEB(printk("hwmemcpy:from 0x%08x\n",reg_d));
+		writel(reg_d,reg_a);
+		// DA
+		reg_a = IO_ADDRESS(SL2312_DRAM_CTRL_BASE)+DRAMCTL_DMA_DA;
+		reg_d = (unsigned int )__virt_to_phys(to) + i*MEMCPY_UNIT;
+		writel(reg_d,reg_a);
+		DEB(printk("hwmemcpy:to 0x%08x\n",reg_d));
+		// byte count
+		reg_a = IO_ADDRESS(SL2312_DRAM_CTRL_BASE)+DRAMCTL_DMA_CNT;
+		reg_d = (count>=MEMCPY_UNIT)?MEMCPY_UNIT:count;
+		writel(reg_d,reg_a);
+		// start DMA
+		reg_a = IO_ADDRESS(SL2312_DRAM_CTRL_BASE)+DRAMCTL_DMA_CTL;
+		writel(0x80000001,reg_a);
+
+		do{
+			cond_resched();
+//			msleep(4);
+			reg_d = readl(IO_ADDRESS(SL2312_DRAM_CTRL_BASE)+DRAMCTL_DMA_CTL);
+		}while(reg_d&0x1);
+
+		count -= MEMCPY_UNIT;
+		i++;
+	}
+
+	return bytes;
+}
+
+static irqreturn_t ipi_interrupt()
+{
+	unsigned int id=getcpuid(),tmp;
+
+	//dmac_inv_range(__phys_to_virt(SL2312_SRAM_BASE),__phys_to_virt(SHAREADDR)+0x2000);
+
+
+	// Clear Interrupt
+	if(id==CPU0) {
+		tmp = readl(CPU1_STATUS);
+		tmp &= ~CPU_IPI_BIT_MASK;
+		writel(tmp,CPU1_STATUS);
+	}
+	else{
+		tmp = readl(CPU0_STATUS);
+		tmp &= ~CPU_IPI_BIT_MASK;
+		writel(tmp,CPU0_STATUS);
+	}
+
+	//
+	DEB(printk("ipi interrupt:0x%x\n",rsp->status));
+	switch(rsp->status){
+		case JSCALE_STATUS_OK:
+
+			break;
+		case JSCALE_UNKNOWN_MSG_TYPE:
+
+			break;
+		case JSCALE_FAILED_FILE_SIZE:
+
+			break;
+		case JSCALE_FAILED_MALLOC:
+
+			break;
+		case JSCALE_FAILED_FORMAT:
+
+			break;
+		case JSCALE_DECODE_ERROR:
+
+			break;
+
+	}
+	jscale_status = rsp->status;
+//	wake_up(&gemini_ipi_wait[JSCALE_WAIT]);
+
+	return IRQ_HANDLED;
+}
+
+static int gemini_ipi_open(struct inode *inode, struct file *file)
+{
+	DEB(printk("ipi open\n"));
+	return 0;
+}
+
+
+static int gemini_ipi_release(struct inode *inode, struct file *file)
+{
+	DEB(printk("ipi release\n"));
+	return 0;
+}
+
+
+static int gemini_ipi_ioctl(struct inode *inode, struct file *file,
+	unsigned int cmd, unsigned long arg)
+{
+	JSCALE_RSP_T tmp;
+
+	switch(cmd) {
+		case GEMINI_IPI_JSCALE_REQ:
+			DEB(printk("ipi:ioctl jscale request %dX%d Q:%d\n",req->ScaledImageWidth,req->ScaledImageHeight,req->ScaledImageQuality));
+			if (copy_from_user(req, (JSCALE_REQ_T *)arg, sizeof(JSCALE_REQ_T)))
+				return -EFAULT;
+			req->hdr.type = IPC_JSCALE_REQ_MSG;
+			req->hdr.length = sizeof(JSCALE_REQ_T);
+			req->input_location  = CPU_1_DATA_OFFSET;
+			req->output_location = CPU_1_DATA_OFFSET;
+			break;
+		case GEMINI_IPI_JSCALE_STAT:
+			DEB(printk("ipi:ioctl jscale stat \n"));
+			if(jscale_status==JSCALE_BUSY){						// not yet
+				tmp.status = JSCALE_BUSY;
+				if (copy_to_user((JSCALE_RSP_T *)arg,&tmp, sizeof(JSCALE_RSP_T)))
+					return -EFAULT;
+			}
+			else{												// finish or error
+				if (copy_to_user((JSCALE_RSP_T *)arg,rsp, sizeof(JSCALE_RSP_T)))
+					return -EFAULT;
+			}
+			break;
+		default:
+			printk("IPI: Error IOCTL number\n");
+			return -ENOIOCTLCMD;
+	}
+
+	return 0;
+}
+
+#define SRAM_SIZE	0x2000
+static ssize_t gemini_ipi_write(struct file *file_p, const char *buf, size_t count, loff_t * ppos)
+{
+	int i=0,tmp=0,j;
+	const char *ptr=(unsigned int)__phys_to_virt(CPU_1_MEM_BASE+CPU_1_DATA_OFFSET);
+	DEB(printk("ipi:write 0x%x to 0x%x length:%d\n",&buf,ptr,count));
+	memcpy(ptr,buf,count);
+	consistent_sync(ptr,count, DMA_TO_DEVICE);
+	//hw_memcpy(ptr,&buf,count);
+
+/*	if(count>SRAM_SIZE){
+		for(i=0;i<(count/SRAM_SIZE);i++)
+			raid_memcpy(ptr+i*SRAM_SIZE,buf+i*SRAM_SIZE,SRAM_SIZE);
+		if(count%SRAM_SIZE)
+			raid_memcpy(ptr+i*SRAM_SIZE,buf+i*SRAM_SIZE,count%SRAM_SIZE);
+	}
+	else
+		raid_memcpy(ptr,buf,count);
+*/
+
+/*	for(i=0;i<count;i++){
+		if(buf[i]!=ptr[i])
+			printk("ipi error:offset %d valud %x[should %x]\n",i,ptr[i],buf[i]);
+	}
+
+	printk("===========input buf===============\n");
+	for(i=0;i<64;i+=16){
+		for(j=0;j<16;j++)
+			printk("%02x ",buf[i+j]);
+		printk("\n");
+		cond_resched();
+	}
+	printk("===========output buf==============\n");
+	for(i=0;i<64;i+=16){
+		for(j=0;j<16;j++)
+			printk("%02x ",ptr[i+j]);
+		printk("\n");
+		cond_resched();
+	}
+*/
+	// send irq for CPU1
+	tmp |= CPU_IPI_BIT_MASK;
+	writel(tmp,CPU0_STATUS);
+	jscale_status = JSCALE_BUSY;
+
+	return count;
+}
+
+static ssize_t gemini_ipi_read(struct file * file_p, char *buf, size_t length, loff_t * ppos)
+{
+	int i=0;
+	const char *ptr=(unsigned int )__phys_to_virt(CPU_1_MEM_BASE+CPU_1_DATA_OFFSET);
+
+	consistent_sync(ptr,length, DMA_FROM_DEVICE);
+	memcpy(buf,ptr,length);
+	DEB(printk("ipi:read 0x%x to 0x%x length:%d\n",ptr,buf,length));
+
+	//consistent_sync((unsigned int *)ptr,0x2000, DMA_FROM_DEVICE);		// invalid
+	//hw_memcpy(buf,ptr,length);
+
+	// need encoded file size ********
+/*	if(count>SRAM_SIZE){
+		for(i=0;i<(count/SRAM_SIZE);i++)
+			raid_memcpy(buf+i*SRAM_SIZE,p_mbox->message+i*SRAM_SIZE,SRAM_SIZE);
+		if(count%0xFFFF)
+			raid_memcpy(buf+i*SRAM_SIZE,p_mbox->message+i*SRAM_SIZE,length%SRAM_SIZE);
+	}
+	else
+		raid_memcpy(buf,p_mbox->message,length);
+*/
+	return length;
+}
+
+void do_mapping_read(struct address_space *mapping,
+			     struct file_ra_state *_ra,
+			     struct file *filp,
+			     loff_t *ppos,
+			     read_descriptor_t *desc,
+			     read_actor_t actor)
+{
+	struct inode *inode = mapping->host;
+	unsigned long index;
+	unsigned long end_index;
+	unsigned long offset;
+	unsigned long last_index;
+	unsigned long next_index;
+	unsigned long prev_index;
+	loff_t isize;
+	struct page *cached_page;
+	int error;
+	struct file_ra_state ra = *_ra;
+
+	cached_page = NULL;
+	index = *ppos >> PAGE_CACHE_SHIFT;
+	next_index = index;
+	prev_index = ra.prev_page;
+	last_index = (*ppos + desc->count + PAGE_CACHE_SIZE-1) >> PAGE_CACHE_SHIFT;
+	offset = *ppos & ~PAGE_CACHE_MASK;
+
+	isize = i_size_read(inode);
+	if (!isize)
+		goto out;
+
+	end_index = (isize - 1) >> PAGE_CACHE_SHIFT;
+	for (;;) {
+		struct page *page;
+		unsigned long nr, ret;
+
+		/* nr is the maximum number of bytes to copy from this page */
+		nr = PAGE_CACHE_SIZE;
+		if (index >= end_index) {
+			if (index > end_index)
+				goto out;
+			nr = ((isize - 1) & ~PAGE_CACHE_MASK) + 1;
+			if (nr <= offset) {
+				goto out;
+			}
+		}
+		nr = nr - offset;
+
+		cond_resched();
+		if (index == next_index)
+			next_index = page_cache_readahead(mapping, &ra, filp,
+					index, last_index - index);
+
+find_page:
+		page = find_get_page(mapping, index);
+		if (unlikely(page == NULL)) {
+			handle_ra_miss(mapping, &ra, index);
+			goto no_cached_page;
+		}
+		if (!PageUptodate(page))
+			goto page_not_up_to_date;
+page_ok:
+
+		/* If users can be writing to this page using arbitrary
+		 * virtual addresses, take care about potential aliasing
+		 * before reading the page on the kernel side.
+		 */
+		if (mapping_writably_mapped(mapping))
+			flush_dcache_page(page);
+
+		/*
+		 * When (part of) the same page is read multiple times
+		 * in succession, only mark it as accessed the first time.
+		 */
+		if (prev_index != index)
+			mark_page_accessed(page);
+		prev_index = index;
+
+		/*
+		 * Ok, we have the page, and it's up-to-date, so
+		 * now we can copy it to user space...
+		 *
+		 * The actor routine returns how many bytes were actually used..
+		 * NOTE! This may not be the same as how much of a user buffer
+		 * we filled up (we may be padding etc), so we can only update
+		 * "pos" here (the actor routine has to update the user buffer
+		 * pointers and the remaining count).
+		 */
+		ret = actor(desc, page, offset, nr);
+		offset += ret;
+		index += offset >> PAGE_CACHE_SHIFT;
+		offset &= ~PAGE_CACHE_MASK;
+
+		page_cache_release(page);
+		if (ret == nr && desc->count)
+			continue;
+		goto out;
+
+page_not_up_to_date:
+		/* Get exclusive access to the page ... */
+		lock_page(page);
+
+		/* Did it get unhashed before we got the lock? */
+		if (!page->mapping) {
+			unlock_page(page);
+			page_cache_release(page);
+			continue;
+		}
+
+		/* Did somebody else fill it already? */
+		if (PageUptodate(page)) {
+			unlock_page(page);
+			goto page_ok;
+		}
+
+readpage:
+		/* Start the actual read. The read will unlock the page. */
+		error = mapping->a_ops->readpage(filp, page);
+
+		if (unlikely(error))
+			goto readpage_error;
+
+		if (!PageUptodate(page)) {
+			lock_page(page);
+			if (!PageUptodate(page)) {
+				if (page->mapping == NULL) {
+					/*
+					 * invalidate_inode_pages got it
+					 */
+					unlock_page(page);
+					page_cache_release(page);
+					goto find_page;
+				}
+				unlock_page(page);
+				error = -EIO;
+				goto readpage_error;
+			}
+			unlock_page(page);
+		}
+
+		/*
+		 * i_size must be checked after we have done ->readpage.
+		 *
+		 * Checking i_size after the readpage allows us to calculate
+		 * the correct value for "nr", which means the zero-filled
+		 * part of the page is not copied back to userspace (unless
+		 * another truncate extends the file - this is desired though).
+		 */
+		isize = i_size_read(inode);
+		end_index = (isize - 1) >> PAGE_CACHE_SHIFT;
+		if (unlikely(!isize || index > end_index)) {
+			page_cache_release(page);
+			goto out;
+		}
+
+		/* nr is the maximum number of bytes to copy from this page */
+		nr = PAGE_CACHE_SIZE;
+		if (index == end_index) {
+			nr = ((isize - 1) & ~PAGE_CACHE_MASK) + 1;
+			if (nr <= offset) {
+				page_cache_release(page);
+				goto out;
+			}
+		}
+		nr = nr - offset;
+		goto page_ok;
+
+readpage_error:
+		/* UHHUH! A synchronous read error occurred. Report it */
+		desc->error = error;
+		page_cache_release(page);
+		goto out;
+
+no_cached_page:
+		/*
+		 * Ok, it wasn't cached, so we need to create a new
+		 * page..
+		 */
+		if (!cached_page) {
+			cached_page = page_cache_alloc_cold(mapping);
+			if (!cached_page) {
+				desc->error = -ENOMEM;
+				goto out;
+			}
+		}
+		error = add_to_page_cache_lru(cached_page, mapping,
+						index, GFP_KERNEL);
+		if (error) {
+			if (error == -EEXIST)
+				goto find_page;
+			desc->error = error;
+			goto out;
+		}
+		page = cached_page;
+		cached_page = NULL;
+		goto readpage;
+	}
+
+out:
+	*_ra = ra;
+
+	*ppos = ((loff_t) index << PAGE_CACHE_SHIFT) + offset;
+	if (cached_page)
+		page_cache_release(cached_page);
+	if (filp)
+		file_accessed(filp);
+}
+
+int ipi_send_actor(read_descriptor_t * desc, struct page *page, unsigned long offset, unsigned long size)
+{
+	ssize_t written;
+	unsigned long count = desc->count;
+	struct file *file = desc->arg.data;
+	unsigned int *ptr_to=(unsigned int)__phys_to_virt(CPU_1_MEM_BASE+CPU_1_DATA_OFFSET) + desc->written;
+	void *ptr_from;
+
+	if (size > count)
+		size = count;
+
+	ptr_from = page_address(page)+offset;
+	written = memcpy(ptr_to,ptr_from,size);
+
+	if (written < 0) {
+		desc->error = written;
+		written = 0;
+	}
+	desc->count = count - written;
+	desc->written += written;
+	return written;
+}
+
+ssize_t gemini_ipi_sendfile(struct file *in_file, loff_t *ppos,
+			 size_t count, read_actor_t actor, void *TARGET)
+{
+	read_descriptor_t desc;
+
+	if (!count)
+		return 0;
+
+	desc.written = 0;
+	desc.count = count;
+	desc.arg.data = TARGET;
+	desc.error = 0;
+
+	do_mapping_read(in_file->f_mapping,&in_file->f_ra,in_file, ppos, &desc, ipi_send_actor);
+
+	if (desc.written)
+		return desc.written;
+	return desc.error;
+}
+static struct file_operations gemini_ipi_fops = {
+	.owner	=	THIS_MODULE,
+	.ioctl	=	gemini_ipi_ioctl,
+	.open	=	gemini_ipi_open,
+	.release=	gemini_ipi_release,
+	.write	=	gemini_ipi_write,
+	.read	=	gemini_ipi_read,
+	.sendfile = gemini_ipi_sendfile,
+};
+
+#ifndef STORLINK_IPI
+#define STORLINK_IPI	242		// Documents/devices.txt suggest to use 240~255 for local driver!!
+#endif
+
+static struct miscdevice gemini_ipi_miscdev =
+{
+	STORLINK_IPI,
+	"slave_ipc",
+	&gemini_ipi_fops
+};
+
+int __init sl_ipi_init(void)
+{
+
+	printk("Gemini IPI Driver Initialization...\n");
+	printk("REQ Head :0x%x(phy:0x%x)\n",(unsigned int)req,(unsigned int)SL2312_SRAM_BASE);
+	printk("RSP Head :0x%x(phy:0x%x)\n",(unsigned int)rsp,(unsigned int)SL2312_SRAM_BASE+0x20);
+	printk("Data buff:0x%x(phy:0x%x)\n",__phys_to_virt(CPU_1_MEM_BASE+CPU_1_DATA_OFFSET),CPU_1_MEM_BASE+CPU_1_DATA_OFFSET);
+
+	misc_register(&gemini_ipi_miscdev);
+
+	if (request_irq(IRQ_CPU0_IP_IRQ_OFFSET, ipi_interrupt, SA_INTERRUPT, "ipi", NULL))
+		printk("Error: Register IRQ for Storlink IPI failed\n");
+
+	return 0;
+}
+
+void __exit sl_ipi_exit(void)
+{
+
+}
+
+module_init(sl_ipi_init);
+module_exit(sl_ipi_exit);
+
+MODULE_AUTHOR("Jason Lee <jason@storlink.com.tw>");
+MODULE_DESCRIPTION("Storlink IPI driver");
+MODULE_LICENSE("GPL");
--- /dev/null
+++ b/arch/arm/mach-sl2312/hw_xor.h
@@ -0,0 +1,573 @@
+/*
+*  linux/include/asm-arm/xor.h
+*
+*  Copyright (C) 2001 Storlink Semi.
+* 	Jason Lee <jason@storlink.com.tw>
+*
+*/
+#include <asm/arch/sl2312.h>
+#include <asm/io.h>
+//#include <linux/compatmac.h>
+
+#undef BIG_ENDIAN
+#define CPU 		0
+#define DMA 		1
+
+#define DESC_NO	8
+#define TX_DESC_NUM		DESC_NO
+#define RX_DESC_NUM		DESC_NO
+
+#define RAID_BASE_ADDR	IO_ADDRESS(SL2312_RAID_BASE)
+
+#define SRAM_PAR_0k		0
+#define SRAM_PAR_4k		1
+#define SRAM_PAR_8k		2
+#define SRAM_PAR_16k		3
+#define SRAM_PAR_SIZE	SRAM_PAR_8k
+
+#define RUNNING	 	0x1
+#define COMPLETE 	0x2
+#define ERROR 		0x4
+
+#define CMD_XOR		0x0
+#define CMD_FILL	0x1
+#define CMD_CPY		0x3
+#define CMD_CHK		0x4
+
+enum RAID_DMA_REGISTER {
+	RAID_DMA_DEVICE_ID		= 0xff00,
+	RAID_DMA_STATUS			= 0xff04,
+	RAID_FCHDMA_CTRL		= 0xff08,
+	RAID_FCHDMA_FIRST_DESC	= 0xff0C,
+	RAID_FCHDMA_CURR_DESC	= 0xff10,
+	RAID_STRDMA_CTRL		= 0xff14,
+	RAID_STRDMA_FIRST_DESC	= 0xff18,
+	RAID_STRDMA_CURR_DESC	= 0xff1C,
+	RAID_TX_FLG_REG			= 0xff24,
+	RAID_RX_FLG_REG			= 0xff34,
+	RAID_PCR				= 0xff50,
+	SMC_CMD_REG				= 0xff60,
+	SMC_STATUS_REG			= 0xff64
+	};
+
+enum RAID_FUNC_MODE {
+	RAID_XOR			= 0,
+	RAID_MIX			= 2,
+	RAID_SRAM			= 3,
+	RAID_ENDIAN			= 4,
+	RAID_MEM_BLK		= 5,
+	RAID_MEM2MEM		= 7,
+	RAID_BUF_SIZE		= 8,
+	RAID_ERR_TEST		= 9,
+	RAID_BURST			= 10,
+	RAID_BUS			= 11
+	};
+
+typedef struct reg_info {
+	int mask;
+	char err[32];
+	int offset;
+} REG_INFO;
+
+/********************************************************/
+/* 	the definition of RAID DMA Module Register      */
+/********************************************************/
+typedef union
+{
+	unsigned int bit32;
+	struct bits_ff00
+	{
+		#ifdef BIG_ENDIAN
+		unsigned int  				: 8;
+		unsigned int teytPerr		: 4; /* define protocol error under tsPErrI*/
+		unsigned int reytPerr		: 14; /* define protocol error under rsPErrI */
+		unsigned int device_id		: 12;
+		unsigned int revision_id	: 4;
+		#else
+		unsigned int revision_id	: 4;
+		unsigned int device_id		: 12;
+		unsigned int reytPerr		: 14; /* define protocol error under rsPErrI */
+		unsigned int teytPerr		: 4; /* define protocol error under tsPErrI*/
+		unsigned int 				: 8;
+		#endif
+	} bits;
+} RAID_DMA_DEVICE_ID_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bits_ff04
+	{
+		#ifdef BIG_ENDIAN
+		unsigned int tsFinishI		: 1; /* owner bit error interrupt */
+		unsigned int tsDErrI		: 1; /* AHB bus error interrupt */
+		unsigned int tsPErrI		: 1; /* RAID XOR fetch descriptor protocol error interrupt */
+		unsigned int tsEODI			: 1; /* RAID XOR fetch DMA end of descriptor interrupt */
+		unsigned int tsEOFI			: 1; /* RAID XOR fetch DMA end of frame interrupt */
+		unsigned int rsFinishI		: 1; /* owner bit error interrupt */
+		unsigned int rsDErrI 		: 1; /* AHB bus error while RAID XOR store interrupt */
+		unsigned int rsPErrI		: 1; /* RAID XOR store descriptor protocol error interrupt */
+		unsigned int rsEODI			: 1; /* RAID XOR store DMA end of descriptor interrupt */
+		unsigned int rsEOFI			: 1; /* RAID XOR store DMA end of frame interrupt */
+		unsigned int inter			: 8; /* pattern check error interrupt */
+		unsigned int 				: 5;
+		unsigned int Loopback		: 1; /* loopback */
+		unsigned int intEnable		: 8; /*pattern check error interrupt enable */
+		#else
+		unsigned int intEnable		: 8; /*pattern check error interrupt enable */
+		unsigned int Loopback		: 1; /* loopback */
+		unsigned int 				: 5;
+		unsigned int inter			: 8; /* pattern check error interrupt */
+		unsigned int rsEOFI			: 1; /* RAID XOR store DMA end of frame interrupt */
+		unsigned int rsEODI			: 1; /* RAID XOR store DMA end of descriptor interrupt */
+		unsigned int rsPErrI		: 1; /* RAID XOR store descriptor protocol error interrupt */
+		unsigned int rsDErrI 		: 1; /* AHB bus error while RAID XOR store interrupt */
+		unsigned int rsFinishI		: 1; /* owner bit error interrupt */
+		unsigned int tsEOFI			: 1; /* RAID XOR fetch DMA end of frame interrupt */
+		unsigned int tsEODI			: 1; /* RAID XOR fetch DMA end of descriptor interrupt */
+		unsigned int tsPErrI		: 1; /* RAID XOR fetch descriptor protocol error interrupt */
+		unsigned int tsDErrI		: 1; /* AHB bus error interrupt */
+		unsigned int tsFinishI		: 1; /* owner bit error interrupt */
+		#endif
+	} bits;
+} RAID_DMA_STATUS_T;
+
+
+typedef union
+{
+	unsigned int bits32;
+	struct bits_ff08
+	{
+		#ifdef BIG_ENDIAN
+		unsigned int td_start		:  1;	/* Start DMA transfer */
+		unsigned int td_continue	:  1;   /* Continue DMA operation */
+		unsigned int td_chain_mode	:  1;	/* Descriptor Chain Mode;1-Descriptor Chain mode, 0-Direct DMA mode*/
+		unsigned int 				:  1;
+		unsigned int td_prot		:  4;	/* DMA protection control */
+		unsigned int td_burst_size  :  2;	/* DMA max burst size for every AHB request */
+		unsigned int td_bus		    :  2;	/* peripheral bus width */
+		unsigned int td_endian		:  1;	/* AHB Endian. 0-little endian; 1-big endian */
+		unsigned int td_finish_en   :  1;	/* DMA Finish Event Interrupt Enable;1-enable;0-mask */
+		unsigned int td_fail_en 	:  1;	/* DMA Fail Interrupt Enable;1-enable;0-mask */
+		unsigned int td_perr_en 	:  1;	/* Protocol Failure Interrupt Enable;1-enable;0-mask */
+		unsigned int td_eod_en  	:  1;	/* End of Descriptor interrupt Enable;1-enable;0-mask */
+		unsigned int td_eof_en      :  1;   /* End of frame interrupt Enable;1-enable;0-mask */
+		unsigned int 				: 14;
+		#else
+		unsigned int 				: 14;
+		unsigned int td_eof_en      :  1;   /* End of frame interrupt Enable;1-enable;0-mask */
+		unsigned int td_eod_en  	:  1;	/* End of Descriptor interrupt Enable;1-enable;0-mask */
+		unsigned int td_perr_en 	:  1;	/* Protocol Failure Interrupt Enable;1-enable;0-mask */
+		unsigned int td_fail_en 	:  1;	/* DMA Fail Interrupt Enable;1-enable;0-mask */
+		unsigned int td_finish_en   :  1;	/* DMA Finish Event Interrupt Enable;1-enable;0-mask */
+		unsigned int td_endian		:  1;	/* AHB Endian. 0-little endian; 1-big endian */
+		unsigned int td_bus		    :  2;	/* peripheral bus width;0 - 8 bits;1 - 16 bits */
+		unsigned int td_burst_size  :  2;	/* TxDMA max burst size for every AHB request */
+		unsigned int td_prot		:  4;	/* TxDMA protection control */
+		unsigned int 				:  1;
+		unsigned int td_chain_mode	:  1;	/* Descriptor Chain Mode;1-Descriptor Chain mode, 0-Direct DMA mode*/
+		unsigned int td_continue	:  1;   /* Continue DMA operation */
+		unsigned int td_start		:  1;	/* Start DMA transfer */
+		#endif
+	} bits;
+} RAID_TXDMA_CTRL_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bits_ff0c
+	{
+		#ifdef BIG_ENDIAN
+		unsigned int td_first_des_ptr	: 28;/* first descriptor address */
+		unsigned int td_busy			:  1;/* 1-TxDMA busy; 0-TxDMA idle */
+		unsigned int 					:  3;
+		#else
+		unsigned int 					:  3;
+		unsigned int td_busy			:  1;/* 1-TxDMA busy; 0-TxDMA idle */
+		unsigned int td_first_des_ptr	: 28;/* first descriptor address */
+		#endif
+	} bits;
+} RAID_TXDMA_FIRST_DESC_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bits_ff10
+	{
+		#ifdef BIG_ENDIAN
+		unsigned int ndar			: 28;	/* next descriptor address */
+		unsigned int eofie			:  1;	/* end of frame interrupt enable */
+		unsigned int    			:  1;
+		unsigned int sof_eof    	:  2;
+		#else
+		unsigned int sof_eof		:  2;
+		unsigned int 				:  1;
+		unsigned int eofie			:  1;	/* end of frame interrupt enable */
+		unsigned int ndar			: 28;	/* next descriptor address */
+		#endif
+	} bits;
+} RAID_TXDMA_CURR_DESC_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bits_ff14
+	{
+		#ifdef BIG_ENDIAN
+		unsigned int rd_start		:  1;	/* Start DMA transfer */
+		unsigned int rd_continue	:  1;   /* Continue DMA operation */
+		unsigned int rd_chain_mode	:  1;	/* Descriptor Chain Mode;1-Descriptor Chain mode, 0-Direct DMA mode*/
+		unsigned int 				:  1;
+		unsigned int rd_prot		:  4;	/* DMA protection control */
+		unsigned int rd_burst_size  :  2;	/* DMA max burst size for every AHB request */
+		unsigned int rd_bus		    :  2;	/* peripheral bus width;0 - 8 bits;1 - 16 bits */
+		unsigned int rd_endian		:  1;	/* AHB Endian. 0-little endian; 1-big endian */
+		unsigned int rd_finish_en   :  1;	/* DMA Finish Event Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_fail_en  	:  1;	/* DMA Fail Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_perr_en 	:  1;	/* Protocol Failure Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_eod_en  	:  1;	/* End of Descriptor interrupt Enable;1-enable;0-mask */
+		unsigned int rd_eof_en      :  1;   /* End of frame interrupt Enable;1-enable;0-mask */
+		unsigned int 				: 14;
+		#else
+		unsigned int 				: 14;
+		unsigned int rd_eof_en      :  1;   /* End of frame interrupt Enable;1-enable;0-mask */
+		unsigned int rd_eod_en  	:  1;	/* End of Descriptor interrupt Enable;1-enable;0-mask */
+		unsigned int rd_perr_en 	:  1;	/* Protocol Failure Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_fail_en  	:  1;	/* DMA Fail Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_finish_en   :  1;	/* DMA Finish Event Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_endian		:  1;	/* AHB Endian. 0-little endian; 1-big endian */
+		unsigned int rd_bus		    :  2;	/* peripheral bus width;0 - 8 bits;1 - 16 bits */
+		unsigned int rd_burst_size  :  2;	/* DMA max burst size for every AHB request */
+		unsigned int rd_prot		:  4;	/* DMA protection control */
+		unsigned int 				:  1;
+		unsigned int rd_chain_mode	:  1;	/* Descriptor Chain Mode;1-Descriptor Chain mode, 0-Direct DMA mode*/
+		unsigned int rd_continue	:  1;   /* Continue DMA operation */
+		unsigned int rd_start		:  1;	/* Start DMA transfer */
+		#endif
+	} bits;
+} RAID_RXDMA_CTRL_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bits_ff18
+	{
+		#ifdef BIG_ENDIAN
+		unsigned int rd_first_des_ptr	: 28;/* first descriptor address */
+		unsigned int rd_busy			:  1;/* 1-RxDMA busy; 0-RxDMA idle */
+		unsigned int 					:  3;
+		#else
+		unsigned int 					:  3;
+		unsigned int rd_busy			:  1;/* 1-RxDMA busy; 0-RxDMA idle */
+		unsigned int rd_first_des_ptr	: 28;/* first descriptor address */
+		#endif
+	} bits;
+} RAID_RXDMA_FIRST_DESC_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bits_ff1c
+	{
+		#ifdef BIG_ENDIAN
+		unsigned int ndar			: 28;	/* next descriptor address */
+		unsigned int eofie			:  1;	/* end of frame interrupt enable */
+		unsigned int dec			:  1;	/* AHB bus address increment(0)/decrement(1) */
+		unsigned int sof_eof		:  2;
+		#else
+		unsigned int sof_eof		:  2;
+		unsigned int dec			:  1;	/* AHB bus address increment(0)/decrement(1) */
+		unsigned int eofie			:  1;	/* end of frame interrupt enable */
+		unsigned int ndar			: 28;	/* next descriptor address */
+		#endif
+	} bits;
+} RAID_RXDMA_CURR_DESC_T;
+
+typedef union
+{
+	unsigned int bit32;
+	struct bits_ff50
+	{
+		unsigned int pat			: 32; /* data for pattern check */
+	} bits;
+} RAID_PACR_T;
+
+/******************************************************/
+/*	the definition of DMA Descriptor Register     */
+/******************************************************/
+typedef struct raid_descriptor_t
+{
+	union func_ctrl_t
+	{
+		unsigned int bit32;
+		struct bits_0000
+		{
+			#ifdef BIG_ENDIAN
+			unsigned int own				: 1; /* owner bit */
+			unsigned int derr				: 1;	/* data error during processing this descriptor */
+			unsigned int perr				: 1;	/* protocol error during processing this descriptor */
+			unsigned int raid_ctrl_status	: 7; /* pass RAID XOR fetch/store control status to CPU */
+			unsigned int desc_cnt			: 6;
+			unsigned int buffer_size		: 16;	/* transfer buffer size associated with current description*/
+			#else
+			unsigned int buffer_size		: 16;	/* transfer buffer size associated with current description*/
+			unsigned int desc_cnt			: 6;
+			unsigned int raid_ctrl_status	: 7; /* pass RAID XOR fetch/store control status to CPU */
+			unsigned int perr				: 1;	/* protocol error during processing this descriptor */
+			unsigned int derr				: 1;	/* data error during processing this descriptor */
+			unsigned int own				: 1; /* owner bit */
+			#endif
+		} bits;
+	} func_ctrl;
+
+	union flg_status_t
+	{
+		unsigned int bits32;
+		struct bit_004
+		{
+			#ifdef BIG_ENDIAN
+			unsigned int bcc 		: 16;
+			unsigned int 			: 13
+			unsigned int mode		: 3;
+			#else
+			unsigned int mode		: 3;
+			unsigned int 			: 13;
+			unsigned int bcc		: 16;
+			#endif
+		} bits_cmd_status;
+	} flg_status;  //Sanders
+
+	unsigned int buf_addr;
+
+	union next_desc_addr_t
+	{
+		unsigned int bits32;
+		struct bits_000c
+		{
+			#ifdef BIG_ENDIAN
+			unsigned int ndar 		: 28; /* next descriptor address */
+			unsigned int eofie		: 1; /* end of frame interrupt enable */
+			unsigned int 			: 1;
+			unsigned int sof_eof	: 2; /* the position of the descriptor in chain */
+			#else
+			unsigned int sof_eof	: 2; /* the position of the descriptor in chain */
+			unsigned int 			: 1;
+			unsigned int eofie		: 1; /* end of frame interrupt enable */
+			unsigned int ndar 		: 28; /* next descriptor address */
+			#endif
+		} bits;
+	} next_desc_addr;
+} RAID_DESCRIPTOR_T;
+
+/******************************************************/
+/*	the offset of RAID SMC register		      */
+/******************************************************/
+enum RAID_SMC_REGISTER {
+	RAID_SMC_CMD_REG		= 0xff60,
+	RAID_SMC_STATUS_REG		= 0xff64
+	};
+
+/******************************************************/
+/*	the definition of RAID SMC module register    */
+/******************************************************/
+typedef union
+{
+	unsigned int bits32;
+	struct bits_ff60
+	{
+		#ifdef BIG_ENDIAN
+		unsigned int pat_mode		: 2; /* partition mode selection */
+		unsigned int 				: 14;
+		unsigned int device_id		: 12;
+		unsigned int revision_id	: 4;
+		#else
+		unsigned int revision_id	: 4;
+		unsigned int device_id		: 12;
+		unsigned int 				: 14;
+		unsigned int pat_mode		: 2; /* partition mode selection */
+		#endif
+	} bits;
+} RAID_SMC_CMD;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bits_ff64
+	{
+		#ifdef BIG_ENDIAN
+		unsigned int addr_err1		: 1; /* address is out of range for controller 1 */
+		unsigned int ahb_err1		: 1; /* AHB bus error for controller 1 */
+		unsigned int 				: 14;
+		unsigned int addr_err2		: 1;	/* address is out of range for controller 2 */
+		unsigned int ahb_err2		: 1; /* AHB bus error for controller 2 */
+		unsigned int 				: 14;
+		#else
+		unsigned int 				: 14;
+		unsigned int ahb_err2		: 1; /* AHB bus error for controller 2 */
+		unsigned int addr_err2		: 1;	/* address is out of range for controller 2 */
+		unsigned int 				: 14;
+		unsigned int ahb_err1		: 1; /* AHB bus error for controller 1 */
+		unsigned int addr_err1		: 1; /* address is out of range for controller 1 */
+		#endif
+	} bits;
+} RAID_SMC_STATUS;
+
+typedef struct RAID_S
+{
+	const char *device_name;
+	wait_queue_head_t wait;
+	unsigned int busy;
+	int irq;
+	unsigned int status;
+	RAID_DESCRIPTOR_T *tx_desc;  /*   point to virtual TX descriptor address */
+	RAID_DESCRIPTOR_T *rx_desc;  /* point ot virtual RX descriptor address */
+	RAID_DESCRIPTOR_T *tx_cur_desc; /* current TX descriptor */
+	RAID_DESCRIPTOR_T *rx_cur_desc; /* current RX descriptor */
+	RAID_DESCRIPTOR_T *tx_finished_desc;
+	RAID_DESCRIPTOR_T *rx_finished_desc;
+	RAID_DESCRIPTOR_T *tx_first_desc;
+	RAID_DESCRIPTOR_T *rx_first_desc;
+
+//	unsigned int *tx_buf[TX_DESC_NUM];
+	unsigned int *rx_desc_dma;			// physical address of rx_descript
+	unsigned int *tx_desc_dma;			// physical address of tx_descript
+	unsigned int *rx_bufs_dma;
+	unsigned int *tx_bufs_dma;
+
+} RAID_T;
+
+struct reg_ioctl
+{
+	unsigned int reg_addr;
+	unsigned int val_in;
+	unsigned int val_out;
+};
+
+typedef struct dma_ctrl {
+	int sram;
+	int prot;
+	int burst;
+	int bus;
+	int endian;
+	int mode;
+} DMA_CTRL;
+
+
+#ifdef XOR_SW_FILL_IN
+
+#define __XOR(a1, a2) a1 ^= a2
+
+#define GET_BLOCK_2(dst) \
+	__asm__("ldmia	%0, {%1, %2}" \
+		: "=r" (dst), "=r" (a1), "=r" (a2) \
+		: "0" (dst))
+
+#define GET_BLOCK_4(dst) \
+	__asm__("ldmia	%0, {%1, %2, %3, %4}" \
+		: "=r" (dst), "=r" (a1), "=r" (a2), "=r" (a3), "=r" (a4) \
+		: "0" (dst))
+
+#define XOR_BLOCK_2(src) \
+	__asm__("ldmia	%0!, {%1, %2}" \
+		: "=r" (src), "=r" (b1), "=r" (b2) \
+		: "0" (src)); \
+	__XOR(a1, b1); __XOR(a2, b2);
+
+#define XOR_BLOCK_4(src) \
+	__asm__("ldmia	%0!, {%1, %2, %3, %4}" \
+		: "=r" (src), "=r" (b1), "=r" (b2), "=r" (b3), "=r" (b4) \
+		: "0" (src)); \
+	__XOR(a1, b1); __XOR(a2, b2); __XOR(a3, b3); __XOR(a4, b4)
+
+#define PUT_BLOCK_2(dst) \
+	__asm__ __volatile__("stmia	%0!, {%2, %3}" \
+		: "=r" (dst) \
+		: "0" (dst), "r" (a1), "r" (a2))
+
+#define PUT_BLOCK_4(dst) \
+	__asm__ __volatile__("stmia	%0!, {%2, %3, %4, %5}" \
+		: "=r" (dst) \
+		: "0" (dst), "r" (a1), "r" (a2), "r" (a3), "r" (a4))
+
+static void
+xor_arm4regs_2(unsigned long bytes, unsigned long *p1, unsigned long *p2)
+{
+	unsigned int lines = bytes / sizeof(unsigned long) / 4;
+	register unsigned int a1 __asm__("r4");
+	register unsigned int a2 __asm__("r5");
+	register unsigned int a3 __asm__("r6");
+	register unsigned int a4 __asm__("r7");
+	register unsigned int b1 __asm__("r8");
+	register unsigned int b2 __asm__("r9");
+	register unsigned int b3 __asm__("ip");
+	register unsigned int b4 __asm__("lr");
+
+	do {
+		GET_BLOCK_4(p1);
+		XOR_BLOCK_4(p2);
+		PUT_BLOCK_4(p1);
+	} while (--lines);
+}
+
+static void
+xor_arm4regs_3(unsigned long bytes, unsigned long *p1, unsigned long *p2,
+		unsigned long *p3)
+{
+	unsigned int lines = bytes / sizeof(unsigned long) / 4;
+	register unsigned int a1 __asm__("r4");
+	register unsigned int a2 __asm__("r5");
+	register unsigned int a3 __asm__("r6");
+	register unsigned int a4 __asm__("r7");
+	register unsigned int b1 __asm__("r8");
+	register unsigned int b2 __asm__("r9");
+	register unsigned int b3 __asm__("ip");
+	register unsigned int b4 __asm__("lr");
+
+	do {
+		GET_BLOCK_4(p1);
+		XOR_BLOCK_4(p2);
+		XOR_BLOCK_4(p3);
+		PUT_BLOCK_4(p1);
+	} while (--lines);
+}
+
+static void
+xor_arm4regs_4(unsigned long bytes, unsigned long *p1, unsigned long *p2,
+		unsigned long *p3, unsigned long *p4)
+{
+	unsigned int lines = bytes / sizeof(unsigned long) / 2;
+	register unsigned int a1 __asm__("r8");
+	register unsigned int a2 __asm__("r9");
+	register unsigned int b1 __asm__("ip");
+	register unsigned int b2 __asm__("lr");
+
+	do {
+		GET_BLOCK_2(p1);
+		XOR_BLOCK_2(p2);
+		XOR_BLOCK_2(p3);
+		XOR_BLOCK_2(p4);
+		PUT_BLOCK_2(p1);
+	} while (--lines);
+}
+
+static void
+xor_arm4regs_5(unsigned long bytes, unsigned long *p1, unsigned long *p2,
+		unsigned long *p3, unsigned long *p4, unsigned long *p5)
+{
+	unsigned int lines = bytes / sizeof(unsigned long) / 2;
+	register unsigned int a1 __asm__("r8");
+	register unsigned int a2 __asm__("r9");
+	register unsigned int b1 __asm__("ip");
+	register unsigned int b2 __asm__("lr");
+
+	do {
+		GET_BLOCK_2(p1);
+		XOR_BLOCK_2(p2);
+		XOR_BLOCK_2(p3);
+		XOR_BLOCK_2(p4);
+		XOR_BLOCK_2(p5);
+		PUT_BLOCK_2(p1);
+	} while (--lines);
+}
+#endif	//XOR_SW_FILL_IN
+
--- /dev/null
+++ b/arch/arm/mach-sl2312/irq.c
@@ -0,0 +1,202 @@
+/*
+ *  linux/arch/arm/mach-epxa10db/irq.c
+ *
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#include <linux/init.h>
+#include <linux/ioport.h>
+#include <linux/stddef.h>
+#include <linux/list.h>
+#include <linux/sched.h>
+#include <asm/hardware.h>
+#include <asm/irq.h>
+#include <asm/io.h>
+#include <asm/mach/irq.h>
+#include <asm/arch/platform.h>
+#include <asm/arch/int_ctrl.h>
+
+#ifdef CONFIG_PCI
+#include <asm/arch/pci.h>
+#endif
+
+int fixup_irq(unsigned int irq)
+{
+#ifdef CONFIG_PCI
+	if (irq == IRQ_PCI) {
+		return sl2312_pci_get_int_src();
+	}
+#endif
+	return irq;
+}
+
+static void sl2312_ack_irq(unsigned int irq)
+{
+   __raw_writel(1 << irq, IRQ_CLEAR(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+}
+
+static void sl2312_mask_irq(unsigned int irq)
+{
+	unsigned int mask;
+
+#ifdef CONFIG_PCI
+	if (irq >= PCI_IRQ_OFFSET)
+	{
+		mask = __raw_readl(IRQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+		mask &= ~IRQ_PCI_MASK ;
+		__raw_writel(mask, IRQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+		sl2312_pci_mask_irq(irq - PCI_IRQ_OFFSET);
+	}
+	else
+#endif
+	if(irq >= FIQ_OFFSET)
+	{
+           mask = __raw_readl(FIQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+           mask &= ~(1 << (irq - FIQ_OFFSET));
+           __raw_writel(mask, FIQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+        }
+        else
+        {
+           mask = __raw_readl(IRQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+           mask &= ~(1 << irq);
+           __raw_writel(mask, IRQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+        }
+
+}
+
+static void sl2312_unmask_irq(unsigned int irq)
+{
+	unsigned int mask;
+
+#ifdef CONFIG_PCI
+	if (irq >= PCI_IRQ_OFFSET)
+	{
+		mask = __raw_readl(IRQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+		mask |= IRQ_PCI_MASK ;
+		__raw_writel(mask, IRQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+		sl2312_pci_unmask_irq(irq - PCI_IRQ_OFFSET);
+	}
+	else
+#endif
+	if(irq >= FIQ_OFFSET)
+        {
+          mask = __raw_readl(FIQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+          mask |= (1 << (irq - FIQ_OFFSET));
+          __raw_writel(mask, FIQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+	}
+        else
+        {
+          mask = __raw_readl(IRQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+          mask |= (1 << irq);
+          __raw_writel(mask, IRQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+        }
+}
+
+static struct irq_chip sl2312_level_irq = {
+        .ack            = sl2312_mask_irq,
+        .mask           = sl2312_mask_irq,
+        .unmask         = sl2312_unmask_irq,
+//		.set_type	= ixp4xx_set_irq_type,
+};
+
+static struct irq_chip sl2312_edge_irq = {
+        .ack            = sl2312_ack_irq,
+        .mask           = sl2312_mask_irq,
+        .unmask         = sl2312_unmask_irq,
+//		.set_type	= ixp4xx_set_irq_type,
+};
+
+static struct resource irq_resource = {
+        .name   = "irq_handler",
+        .start  = IO_ADDRESS(SL2312_INTERRUPT_BASE),
+        .end    = IO_ADDRESS(FIQ_STATUS(SL2312_INTERRUPT_BASE))+4,
+};
+
+void __init sl2312_init_irq(void)
+{
+	unsigned int i, mode, level;
+
+    request_resource(&iomem_resource, &irq_resource);
+
+	for (i = 0; i < NR_IRQS; i++)
+	{
+	    if((i>=IRQ_TIMER1 && i<=IRQ_TIMER3)||(i>=IRQ_SERIRQ0 && i<=IRQ_SERIRQ_MAX))
+        {
+	        set_irq_chip(i, &sl2312_edge_irq);
+	        set_irq_handler(i, handle_edge_irq);
+        }
+	    else
+        {
+	        set_irq_chip(i, &sl2312_level_irq);
+            set_irq_handler(i,handle_level_irq);
+        }
+        set_irq_flags(i, IRQF_VALID | IRQF_PROBE);
+	}
+
+	/* Disable all interrupt */
+	__raw_writel(0,IRQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+	__raw_writel(0,FIQ_MASK(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+
+	/* Set interrupt mode */
+    /* emac & ipsec type is level trigger and high active */
+    mode = __raw_readl(IRQ_TMODE(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+    level = __raw_readl(IRQ_TLEVEL(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+
+	mode &= ~IRQ_GMAC0_MASK;
+	level &= ~IRQ_GMAC0_MASK;
+
+	mode &= ~IRQ_GMAC1_MASK;
+	level &= ~IRQ_GMAC1_MASK;
+
+	mode &= ~IRQ_IPSEC_MASK;
+	level &= ~IRQ_IPSEC_MASK;
+
+	// for IDE0,1, high active and level trigger
+	mode &= ~IRQ_IDE0_MASK;
+	level &= ~IRQ_IDE0_MASK;
+	mode &= ~IRQ_IDE1_MASK;
+	level &= ~IRQ_IDE1_MASK;
+
+
+	// for PCI, high active and level trigger
+	mode &= ~IRQ_PCI_MASK;
+	level &= ~IRQ_PCI_MASK;
+
+	// for USB, high active and level trigger
+	mode &= ~IRQ_USB0_MASK;
+	level &= ~IRQ_USB0_MASK;
+
+	mode &= ~IRQ_USB1_MASK;
+	level &= ~IRQ_USB1_MASK;
+
+	// for LPC, high active and edge trigger
+	mode |= 0xffff0000;
+	level &= 0x0000ffff;
+
+	// for GPIO, high active and level trigger
+	mode &= ~(IRQ_GPIO_MASK);
+	level &= ~(IRQ_GPIO_MASK);
+
+	mode &= ~(IRQ_GPIO1_MASK);
+	level &= ~(IRQ_GPIO1_MASK);
+
+	mode &= ~(IRQ_GPIO2_MASK);
+	level &= ~(IRQ_GPIO2_MASK);
+
+	__raw_writel(mode,IRQ_TMODE(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+	__raw_writel(level,IRQ_TLEVEL(IO_ADDRESS(SL2312_INTERRUPT_BASE)));
+
+}
--- /dev/null
+++ b/arch/arm/mach-sl2312/lpc.c
@@ -0,0 +1,125 @@
+/*
+ *
+ * BRIEF MODULE DESCRIPTION
+ *	ITE Semi IT8712 Super I/O functions.
+ *
+ * Copyright 2001 MontaVista Software Inc.
+ * Author: MontaVista Software, Inc.
+ *         	ppopov@mvista.com or source@mvista.com
+ *
+ *  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.
+ *
+ *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
+ *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
+ *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
+ *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
+ *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
+ *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
+ *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
+ *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ *
+ *  You should have received a copy of the  GNU General Public License along
+ *  with this program; if not, write  to the Free Software Foundation, Inc.,
+ *  675 Mass Ave, Cambridge, MA 02139, USA.
+ */
+#include <linux/kernel.h>
+#include <linux/delay.h>
+#include <asm/io.h>
+#include <asm/types.h>
+#include <asm/arch/it8712.h>
+#include <linux/init.h>
+#include <asm/arch/hardware.h>
+
+#ifndef TRUE
+#define TRUE 1
+#endif
+
+#ifndef FALSE
+#define FALSE 0
+#endif
+
+
+// MB PnP configuration register
+#define LPC_KEY_ADDR	(IO_ADDRESS(SL2312_LPC_IO_BASE) + 0x2e)
+#define LPC_DATA_ADDR	(IO_ADDRESS(SL2312_LPC_IO_BASE) + 0x2f)
+
+#define LPC_BUS_CTRL			*(volatile unsigned char*) (IO_ADDRESS(SL2312_LPC_HOST_BASE) + 0)
+#define LPC_BUS_STATUS			*(volatile unsigned char*) (IO_ADDRESS(SL2312_LPC_HOST_BASE) + 2)
+#define LPC_SERIAL_IRQ_CTRL		*(volatile unsigned char*) (IO_ADDRESS(SL2312_LPC_HOST_BASE) + 4)
+
+int it8712_exist;
+
+static void LPCEnterMBPnP(void)
+{
+	int i;
+	unsigned char key[4] = {0x87, 0x01, 0x55, 0x55};
+
+	for (i = 0; i<4; i++)
+		outb(key[i], LPC_KEY_ADDR);
+
+}
+
+static void LPCExitMBPnP(void)
+{
+	outb(0x02, LPC_KEY_ADDR);
+	outb(0x02, LPC_DATA_ADDR);
+}
+
+void LPCSetConfig(char LdnNumber, char Index, char data)
+{
+	LPCEnterMBPnP();				// Enter IT8712 MB PnP mode
+	outb(0x07, LPC_KEY_ADDR);
+	outb(LdnNumber, LPC_DATA_ADDR);
+	outb(Index, LPC_KEY_ADDR);
+	outb(data, LPC_DATA_ADDR);
+	LPCExitMBPnP();
+}
+
+char LPCGetConfig(char LdnNumber, char Index)
+{
+	char rtn;
+
+	LPCEnterMBPnP();				// Enter IT8712 MB PnP mode
+	outb(0x07, LPC_KEY_ADDR);
+	outb(LdnNumber, LPC_DATA_ADDR);
+	outb(Index, LPC_KEY_ADDR);
+	rtn = inb(LPC_DATA_ADDR);
+	LPCExitMBPnP();
+	return rtn;
+}
+
+static int SearchIT8712(void)
+{
+	unsigned char Id1, Id2;
+	unsigned short Id;
+
+	LPCEnterMBPnP();
+	outb(0x20, LPC_KEY_ADDR); /* chip id byte 1 */
+	Id1 = inb(LPC_DATA_ADDR);
+	outb(0x21, LPC_KEY_ADDR); /* chip id byte 2 */
+	Id2 = inb(LPC_DATA_ADDR);
+	Id = (Id1 << 8) | Id2;
+	LPCExitMBPnP();
+	if (Id == 0x8712)
+		return TRUE;
+	else
+		return FALSE;
+}
+
+int InitLPCInterface(void)
+{
+	LPC_BUS_CTRL = 0xc0;
+	LPC_SERIAL_IRQ_CTRL = 0xc0;
+	mdelay(1);		// wait for 1 serial IRQ cycle
+	LPC_SERIAL_IRQ_CTRL = 0x80;
+	it8712_exist = SearchIT8712();
+	printk("IT8712 %s exist\n", it8712_exist?"":"doesn't");
+	return 0;
+}
+
+//__initcall(InitLPCInterface);
--- /dev/null
+++ b/arch/arm/mach-sl2312/mm.c
@@ -0,0 +1,80 @@
+/*
+ *  linux/arch/arm/mach-epxa10db/mm.c
+ *
+ *  MM routines for Altera'a Epxa10db board
+ *
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#include <linux/sched.h>
+#include <linux/mm.h>
+#include <linux/init.h>
+
+#include <asm/hardware.h>
+#include <asm/io.h>
+#include <asm/pgtable.h>
+#include <asm/page.h>
+#include <asm/sizes.h>
+
+#include <asm/mach/map.h>
+
+/* Page table mapping for I/O region */
+static struct map_desc sl2312_io_desc[] __initdata = {
+#ifdef CONFIG_GEMINI_IPI
+{__phys_to_virt(CPU_1_MEM_BASE),         __phys_to_pfn(CPU_1_MEM_BASE),        SZ_64M,  MT_MEMORY},
+#endif
+{IO_ADDRESS(SL2312_SRAM_BASE),         __phys_to_pfn(SL2312_SRAM_BASE),        SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_DRAM_CTRL_BASE),    __phys_to_pfn(SL2312_DRAM_CTRL_BASE),   SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_GLOBAL_BASE),       __phys_to_pfn(SL2312_GLOBAL_BASE),      SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_WAQTCHDOG_BASE),    __phys_to_pfn(SL2312_WAQTCHDOG_BASE),   SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_UART_BASE),         __phys_to_pfn(SL2312_UART_BASE),        SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_TIMER_BASE),        __phys_to_pfn(SL2312_TIMER_BASE),       SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_LCD_BASE),          __phys_to_pfn(SL2312_LCD_BASE),         SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_RTC_BASE),          __phys_to_pfn(SL2312_RTC_BASE),         SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_SATA_BASE),         __phys_to_pfn(SL2312_SATA_BASE),        SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_LPC_HOST_BASE),     __phys_to_pfn(SL2312_LPC_HOST_BASE),    SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_LPC_IO_BASE),       __phys_to_pfn(SL2312_LPC_IO_BASE),      SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_INTERRUPT_BASE),    __phys_to_pfn(SL2312_INTERRUPT_BASE),   SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_INTERRUPT1_BASE),   __phys_to_pfn(SL2312_INTERRUPT1_BASE),  SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_SSP_CTRL_BASE),     __phys_to_pfn(SL2312_SSP_CTRL_BASE),    SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_POWER_CTRL_BASE),   __phys_to_pfn(SL2312_POWER_CTRL_BASE),  SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_CIR_BASE),          __phys_to_pfn(SL2312_CIR_BASE),         SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_GPIO_BASE),         __phys_to_pfn(SL2312_GPIO_BASE),        SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_GPIO_BASE1),        __phys_to_pfn(SL2312_GPIO_BASE1),       SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_GPIO_BASE2),        __phys_to_pfn(SL2312_GPIO_BASE2),       SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_PCI_IO_BASE),	   __phys_to_pfn(SL2312_PCI_IO_BASE),      SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_PCI_MEM_BASE),	   __phys_to_pfn(SL2312_PCI_MEM_BASE),	   SZ_512K,  MT_DEVICE},
+#ifdef CONFIG_NET_SL351X
+{IO_ADDRESS(SL2312_TOE_BASE),    	__phys_to_pfn(SL2312_TOE_BASE)       ,   SZ_512K,  MT_DEVICE},
+#endif
+{IO_ADDRESS(SL2312_GMAC0_BASE),	       __phys_to_pfn(SL2312_GMAC0_BASE),	   SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_GMAC1_BASE),	       __phys_to_pfn(SL2312_GMAC1_BASE),	   SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_SECURITY_BASE),     __phys_to_pfn(SL2312_SECURITY_BASE),    SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_IDE0_BASE),         __phys_to_pfn(SL2312_IDE0_BASE),        SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_IDE1_BASE),         __phys_to_pfn(SL2312_IDE1_BASE),        SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_RAID_BASE),         __phys_to_pfn(SL2312_RAID_BASE),        SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_FLASH_CTRL_BASE),   __phys_to_pfn(SL2312_FLASH_CTRL_BASE),  SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_DRAM_CTRL_BASE),    __phys_to_pfn(SL2312_DRAM_CTRL_BASE),   SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_GENERAL_DMA_BASE),  __phys_to_pfn(SL2312_GENERAL_DMA_BASE), SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_USB0_BASE),         __phys_to_pfn(SL2312_USB_BASE),         SZ_512K,  MT_DEVICE},
+{IO_ADDRESS(SL2312_USB1_BASE),         __phys_to_pfn(SL2312_USB1_BASE),        SZ_512K,  MT_DEVICE},
+{FLASH_VADDR(SL2312_FLASH_BASE),       __phys_to_pfn(SL2312_FLASH_BASE),       SZ_16M,    MT_DEVICE},
+};
+
+void __init sl2312_map_io(void)
+{
+	iotable_init(sl2312_io_desc, ARRAY_SIZE(sl2312_io_desc));
+}
--- /dev/null
+++ b/arch/arm/mach-sl2312/pci.c
@@ -0,0 +1,359 @@
+/*
+ *  linux/arch/arm/mach-sl2312/pci_sl2312.c
+ *
+ *  PCI functions for sl2312 host PCI bridge
+ *
+ *  Copyright (C) 2003 StorLink Corp.
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#include <linux/sched.h>
+#include <linux/kernel.h>
+#include <linux/pci.h>
+#include <linux/ptrace.h>
+#include <linux/slab.h>
+#include <linux/ioport.h>
+#include <linux/interrupt.h>
+#include <linux/spinlock.h>
+#include <linux/init.h>
+
+#include <asm/sizes.h>
+#include <asm/hardware.h>
+#include <asm/irq.h>
+#include <asm/system.h>
+#include <asm/mach/pci.h>
+#include <asm/mach/irq.h>
+#include <asm/mach-types.h>
+
+#include <asm/arch/pci.h>
+
+//#define DEBUG
+
+// sl2312 PCI bridge access routines
+
+#define PCI_IOSIZE_REG	(*(volatile unsigned long *) (IO_ADDRESS(SL2312_PCI_IO_BASE)))
+#define PCI_PROT_REG	(*(volatile unsigned long *) (IO_ADDRESS(SL2312_PCI_IO_BASE) + 0x04))
+#define PCI_CTRL_REG	(*(volatile unsigned long *) (IO_ADDRESS(SL2312_PCI_IO_BASE) + 0x08))
+#define PCI_SOFTRST_REG	(*(volatile unsigned long *) (IO_ADDRESS(SL2312_PCI_IO_BASE) + 0x10))
+#define PCI_CONFIG_REG	(*(volatile unsigned long *) (IO_ADDRESS(SL2312_PCI_IO_BASE) + 0x28))
+#define PCI_DATA_REG	(*(volatile unsigned long *) (IO_ADDRESS(SL2312_PCI_IO_BASE) + 0x2C))
+
+static spinlock_t sl2312_pci_lock = SPIN_LOCK_UNLOCKED;
+// for initialize PCI devices
+struct resource pci_ioport_resource = {
+		.name = "PCI I/O Space",
+		.start = IO_ADDRESS(SL2312_PCI_IO_BASE) + 0x100,
+		.end = IO_ADDRESS(SL2312_PCI_IO_BASE) + SZ_512K - 1,
+		.flags = IORESOURCE_IO,
+};
+struct resource pci_iomem_resource = {
+		.name = "PCI Mem Space",
+		.start = SL2312_PCI_MEM_BASE,
+		.end = SL2312_PCI_MEM_BASE + SZ_128M - 1,
+		.flags = IORESOURCE_MEM,
+};
+
+static int sl2312_read_config(struct pci_bus *bus, unsigned int devfn, int where,int size, u32 *val)
+{
+	unsigned long addr,data;
+	unsigned long flags;
+
+	spin_lock_irqsave(&sl2312_pci_lock, flags);
+    addr = 0x80000000 | (PCI_SLOT(devfn) << 11) | (PCI_FUNC(devfn) << 8) | (where & ~3);
+	PCI_CONFIG_REG = addr;
+	data = PCI_DATA_REG;
+
+	switch (size) {
+	case 1:
+	    *val = (u8) (data >> ((where & 0x03) * 8));
+		break;
+	case 2:
+	    *val = (u16) (data >> ((where & 0x02) * 8));
+		break;
+	case 4:
+	    *val = data;
+    	if ((where >= 0x10) && (where <= 0x24)) {
+    		if ((*val & 0xfff00000) == SL2312_PCI_IO_BASE) {
+    			*val &= 0x000fffff;
+    			*val |= IO_ADDRESS(SL2312_PCI_IO_BASE);
+    		}
+    	}
+		break;
+	}
+	spin_unlock_irqrestore(&sl2312_pci_lock, flags);
+//	printk("READ==>slot=%d fn=%d where=%d value=%x\n",PCI_SLOT(devfn),PCI_FUNC(devfn),where,*val);
+	return PCIBIOS_SUCCESSFUL;
+}
+
+static int sl2312_write_config(struct pci_bus *bus, unsigned int devfn, int where,int size, u32 val)
+{
+	unsigned long addr,data;
+	unsigned long flags;
+
+	spin_lock_irqsave(&sl2312_pci_lock, flags);
+    addr = 0x80000000 | (PCI_SLOT(devfn) << 11) | (PCI_FUNC(devfn) << 8) | (where & ~3);
+	PCI_CONFIG_REG = addr;
+	data = PCI_DATA_REG;
+
+	switch (size) {
+	case 1:
+    	data &= ~(0xff << ((where & 0x03) * 8));
+    	data |= (val << ((where & 0x03) * 8));
+    	PCI_DATA_REG = data;
+		break;
+	case 2:
+    	data &= ~(0xffff << ((where & 0x02) * 8));
+    	data |= (val << ((where & 0x02) * 8));
+    	PCI_DATA_REG = data;
+		break;
+	case 4:
+    	if ((where >= 0x10) && (where <= 0x24)) {
+    		if ((val & 0xfff00000) == IO_ADDRESS(SL2312_PCI_IO_BASE)) {
+    			val &= 0x000fffff;
+    			val |= SL2312_PCI_IO_BASE;
+    		}
+    	}
+	    PCI_DATA_REG = val;
+		break;
+	}
+	spin_unlock_irqrestore(&sl2312_pci_lock, flags);
+
+//	printk("WRITE==> slot=%d fn=%d where=%d value=%x \n",PCI_SLOT(devfn),PCI_FUNC(devfn),where,val);
+	return PCIBIOS_SUCCESSFUL;
+}
+
+static struct pci_ops sl2312_pci_ops = {
+	.read	= sl2312_read_config,
+	.write	= sl2312_write_config,
+};
+
+
+int __init sl2312_pci_setup_resources(struct resource **resource)
+{
+	PCI_IOSIZE_REG = 0;		// 1M IO size
+	PCI_CTRL_REG = 0x06;
+
+	resource[0] = &pci_ioport_resource;
+	resource[1] = &pci_iomem_resource;
+	resource[2] = NULL;
+
+	return 1;
+}
+
+//static int sl2312_pci_fault(unsigned long addr, struct pt_regs *regs)
+//{
+//	return 1;
+//}
+
+
+/**********************************************************************
+ * MASK(disable) PCI interrupt
+ *    0: PCI INTA, 1: PCI INTB, ...		// for Linux interrupt routing
+ *   16: PERR								// for PCI module internal use
+ *   17: SERR,.. respect to PCI CTRL2 REG
+ **********************************************************************/
+void sl2312_pci_mask_irq(unsigned int irq)
+{
+    struct pci_bus bus;
+	unsigned int tmp;
+
+    bus.number = 0;
+    sl2312_read_config(&bus, 0, SL2312_PCI_CTRL2, 4, &tmp);
+	if (irq < 16) {						// for linux int routing
+		tmp &= ~(1 << (irq + 16 + 6));
+	}
+	else {
+		tmp &= ~(1 << irq);
+	}
+    sl2312_write_config(&bus, 0, SL2312_PCI_CTRL2, 4, tmp);
+}
+
+/* UNMASK(enable) PCI interrupt */
+void sl2312_pci_unmask_irq(unsigned int irq)
+{
+    struct pci_bus bus;
+	unsigned int tmp;
+
+    bus.number = 0;
+    sl2312_read_config(&bus, 0, SL2312_PCI_CTRL2, 4, &tmp);
+	if (irq < 16) {						// for linux int routing
+		tmp |= (1 << (irq + 16 + 6));
+	}
+	else {
+		tmp |= (1 << irq);
+	}
+    sl2312_write_config(&bus, 0, SL2312_PCI_CTRL2, 4, tmp);
+}
+
+/* Get PCI interrupt source */
+int sl2312_pci_get_int_src(void)
+{
+    struct pci_bus bus;
+	unsigned int tmp=0;
+
+    bus.number = 0;
+    sl2312_read_config(&bus, 0, SL2312_PCI_CTRL2, 4, &tmp);
+	if (tmp & (1 << 28)) { 		// PCI INTA
+        sl2312_write_config(&bus, 0, SL2312_PCI_CTRL2, 4, tmp);
+		return IRQ_PCI_INTA;
+	}
+	if (tmp & (1 << 29)) {		// PCI INTB
+        sl2312_write_config(&bus, 0, SL2312_PCI_CTRL2, 4, tmp);
+		return IRQ_PCI_INTB;
+	}
+	if (tmp & (1 << 30)) {		// PCI INTC
+        sl2312_write_config(&bus, 0, SL2312_PCI_CTRL2, 4, tmp);
+		return IRQ_PCI_INTC;
+	}
+	if (tmp & (1 << 31)) {		// PCI INTD
+        sl2312_write_config(&bus, 0, SL2312_PCI_CTRL2, 4, tmp);
+		return IRQ_PCI_INTD;
+	}
+	// otherwise, it should be a PCI error
+	return IRQ_PCI;
+}
+
+static irqreturn_t sl2312_pci_irq(int irq, void *devid)
+{
+    struct irq_desc *desc;
+	struct irqaction *action;
+	int retval = 0;
+
+    return 1;
+
+	irq = sl2312_pci_get_int_src();
+	desc = &irq_desc[irq];
+	action = desc->action;
+	do {
+		retval |= action->handler(irq, devid);
+		action = action->next;
+	} while (action);
+
+    return 1;
+}
+
+//extern int (*external_fault)(unsigned long addr, struct pt_regs *regs);
+
+void __init sl2312_pci_preinit(void)
+{
+    struct pci_bus bus;
+	unsigned long flags;
+	unsigned int temp;
+	int ret;
+
+	/*
+	 * Hook in our fault handler for PCI errors
+	 */
+//	external_fault = sl2312_pci_fault;
+
+	spin_lock_irqsave(&sl2312_pci_lock, flags);
+
+	/*
+	 * Grab the PCI interrupt.
+	 */
+	ret = request_irq(IRQ_PCI, sl2312_pci_irq, 0, "sl2312 pci int", NULL);
+	if (ret)
+		printk(KERN_ERR "PCI: unable to grab PCI error "
+		       "interrupt: %d\n", ret);
+
+	spin_unlock_irqrestore(&sl2312_pci_lock, flags);
+
+	// setup pci bridge
+    bus.number = 0;   /* device 0, function 0 */
+	temp = (SL2312_PCI_DMA_MEM1_BASE & 0xfff00000) | (SL2312_PCI_DMA_MEM1_SIZE << 16);
+    sl2312_write_config(&bus, 0, SL2312_PCI_MEM1_BASE_SIZE, 4, temp);
+}
+
+/*
+ * 	No swizzle on SL2312
+ */
+static u8 __init sl2312_pci_swizzle(struct pci_dev *dev, u8 *pinp)
+{
+	return PCI_SLOT(dev->devfn);
+}
+
+/*
+ * map the specified device/slot/pin to an IRQ.  This works out such
+ * that slot 9 pin 1 is INT0, pin 2 is INT1, and slot 10 pin 1 is INT1.
+ */
+static int __init sl2312_pci_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
+{
+	int intnr = ((slot  + (pin - 1)) & 3) + 4;  /* the IRQ number of PCI bridge */
+
+	// printk("%s : slot = %d  pin = %d \n",__func__,slot,pin);
+    switch (slot)
+    {
+        case 12:
+        	if (pin==1)
+        	{
+		    	intnr = 3;
+		    }
+		    else
+		    {
+		    	intnr = 0;
+		    }
+            break;
+        case 11:
+		    intnr = (2 + (pin - 1)) & 3;
+            break;
+        case 10:
+		    intnr = (1 + (pin - 1)) & 3;
+            break;
+        case  9:
+		    intnr = (pin - 1) & 3;
+            break;
+    }
+//	if (slot == 10)
+//		intnr = (1 + (pin - 1)) & 3;
+//	else if (slot == 9)
+//		intnr = (pin - 1) & 3;
+	return (IRQ_PCI_INTA + intnr);
+}
+
+struct pci_bus * __init sl2312_pci_scan_bus(int nr, struct pci_sys_data *sysdata)
+{
+	return (pci_scan_bus(0, &sl2312_pci_ops, sysdata));
+
+}
+
+int __init sl2312_pci_setup(int nr, struct pci_sys_data *sys)
+{
+	int ret = 0;
+
+	if (nr == 0) {
+		ret = sl2312_pci_setup_resources(sys->resource);
+	}
+
+	return ret;
+}
+
+
+struct hw_pci sl2312_pci __initdata = {
+	.setup          =	sl2312_pci_setup,
+	.preinit		=	sl2312_pci_preinit,
+	.nr_controllers =   1,
+	.swizzle		=	sl2312_pci_swizzle,
+	.map_irq		=	sl2312_pci_map_irq,
+	.scan           =   sl2312_pci_scan_bus,
+};
+
+static int __init sl2312_pci_init(void)
+{
+	if (machine_is_sl2312())
+		pci_common_init(&sl2312_pci);
+	return 0;
+}
+
+subsys_initcall(sl2312_pci_init);
--- /dev/null
+++ b/arch/arm/mach-sl2312/sl2312-otg-1.c
@@ -0,0 +1,64 @@
+/*
+ *  linux/arch/arm/mach-pxa/sl2312.c
+ *
+ *  Author:	Nicolas Pitre
+ *  Created:	Nov 05, 2002
+ *  Copyright:	MontaVista Software Inc.
+ *
+ * Code specific to sl2312 aka Bulverde.
+ *
+ * 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/module.h>
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/pm.h>
+#include <linux/device.h>
+#include "asm/arch/sl2312.h"
+#include "asm/arch/irqs.h"
+#include <asm/hardware.h>
+#include <asm/irq.h>
+#include <linux/platform_device.h>
+
+/*
+ * device registration specific to sl2312.
+ */
+
+static u64 sl2312_dmamask_1 = 0xffffffffUL;
+
+static struct resource sl2312_otg_resources_1[] = {
+	[0] = {
+		.start  = 0x69000000,
+		.end    = 0x69000fff,
+		.flags  = IORESOURCE_MEM,
+	},
+	[1] = {
+		.start  = IRQ_USB1,
+		.end    = IRQ_USB1,
+		.flags  = IORESOURCE_IRQ,
+	},
+};
+
+static struct platform_device ehci_1_device = {
+	.name		= "ehci-hcd-FOTG2XX",
+	.id		= -1,
+	.dev		= {
+		.dma_mask = &sl2312_dmamask_1,
+		.coherent_dma_mask = 0xffffffff,
+	},
+	.num_resources  = ARRAY_SIZE(sl2312_otg_resources_1),
+	.resource       = sl2312_otg_resources_1,
+};
+
+static struct platform_device *devices[] __initdata = {
+	&ehci_1_device,
+};
+
+static int __init sl2312_1_init(void)
+{
+	return platform_add_devices(devices, ARRAY_SIZE(devices));
+}
+
+subsys_initcall(sl2312_1_init);
--- /dev/null
+++ b/arch/arm/mach-sl2312/sl2312-otg.c
@@ -0,0 +1,87 @@
+/*
+ *  linux/arch/arm/mach-pxa/sl2312.c
+ *
+ *  Author:	Nicolas Pitre
+ *  Created:	Nov 05, 2002
+ *  Copyright:	MontaVista Software Inc.
+ *
+ * Code specific to sl2312 aka Bulverde.
+ *
+ * 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/module.h>
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/pm.h>
+#include <linux/device.h>
+#include "asm/arch/sl2312.h"
+#include "asm/arch/irqs.h"
+#include <asm/hardware.h>
+#include <asm/irq.h>
+#include <linux/platform_device.h>
+
+/*
+ * device registration specific to sl2312.
+ */
+
+static u64 sl2312_dmamask = 0xffffffffUL;
+
+static struct resource sl2312_otg_resources_1[] = {
+	[0] = {
+		.start  = 0x68000000,
+		.end    = 0x68000fff,
+		.flags  = IORESOURCE_MEM,
+	},
+	[1] = {
+		.start  = IRQ_USB0,
+		.end    = IRQ_USB0,
+		.flags  = IORESOURCE_IRQ,
+	},
+};
+static struct resource sl2312_otg_resources_2[] = {
+	[2] = {
+		.start  = 0x69000000,
+		.end    = 0x69000fff,
+		.flags  = IORESOURCE_MEM,
+	},
+	[3] = {
+		.start  = IRQ_USB1,
+		.end    = IRQ_USB1,
+		.flags  = IORESOURCE_IRQ,
+	},
+};
+
+static struct platform_device ehci_device_1 = {
+	.name		= "ehci-hcd-FOTG2XX",
+	.id		= 1,
+	.dev		= {
+		.dma_mask = &sl2312_dmamask,
+		.coherent_dma_mask = 0xffffffff,
+	},
+	.num_resources  = ARRAY_SIZE(sl2312_otg_resources_1),
+	.resource       = sl2312_otg_resources_1,
+};
+
+static struct platform_device ehci_device_2 = {
+	.name		= "ehci-hcd-FOTG2XX",
+	.id		= 2,
+	.dev		= {
+		.dma_mask = &sl2312_dmamask,
+		.coherent_dma_mask = 0xffffffff,
+	},
+	.num_resources  = ARRAY_SIZE(sl2312_otg_resources_2),
+	.resource       = sl2312_otg_resources_2,
+};
+
+static struct platform_device *devices[] __initdata = {
+	&ehci_device_1, /* &ehci_device_2, */
+};
+
+static int __init sl2312_init(void)
+{
+	return platform_add_devices(devices, ARRAY_SIZE(devices));
+}
+
+subsys_initcall(sl2312_init);
--- /dev/null
+++ b/arch/arm/mach-sl2312/sl3516_device.c
@@ -0,0 +1,89 @@
+/*
+ *  linux/arch/arm/mach-2312/sl3516_device.c
+ *
+ *  Author:	Nicolas Pitre
+ *  Created:	Nov 05, 2002
+ *  Copyright:	MontaVista Software Inc.
+ *
+ * Code specific to sl2312 aka Bulverde.
+ *
+ * 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/module.h>
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/pm.h>
+#include <linux/device.h>
+#include <linux/platform_device.h>
+#include "asm/arch/sl2312.h"
+#include "asm/arch/irqs.h"
+#include <asm/hardware.h>
+#include <asm/irq.h>
+
+/*
+ * device registration specific to sl2312.
+ */
+
+static u64 sl3516_dmamask = 0xffffffffUL;
+
+static struct resource sl3516_sata_resources[] = {
+	[0] = {
+		.start  = 0x63400000,
+		.end    = 0x63400040,
+		.flags  = IORESOURCE_MEM,
+	},
+	[1] = {
+		.start  = IRQ_IDE1,
+		.end    = IRQ_IDE1,
+		.flags  = IORESOURCE_IRQ,
+	},
+};
+
+static struct platform_device sata_device = {
+	.name		= "lepus-sata",
+	.id		= -1,
+	.dev		= {
+		.dma_mask = &sl3516_dmamask,
+		.coherent_dma_mask = 0xffffffff,
+	},
+	.num_resources  = ARRAY_SIZE(sl3516_sata_resources),
+	.resource       = sl3516_sata_resources,
+};
+
+static struct resource sl3516_sata0_resources[] = {
+	[0] = {
+		.start  = 0x63000000,
+		.end    = 0x63000040,
+		.flags  = IORESOURCE_MEM,
+	},
+	[1] = {
+		.start  = IRQ_IDE0,
+		.end    = IRQ_IDE0,
+		.flags  = IORESOURCE_IRQ,
+	},
+};
+
+static struct platform_device sata0_device = {
+	.name		= "lepus-sata0",
+	.id		= -1,
+	.dev		= {
+		.dma_mask = &sl3516_dmamask,
+		.coherent_dma_mask = 0xffffffff,
+	},
+	.num_resources  = ARRAY_SIZE(sl3516_sata0_resources),
+	.resource       = sl3516_sata0_resources,
+};
+
+static struct platform_device *sata_devices[] __initdata = {
+	&sata_device,
+	&sata0_device,
+};
+
+static int __init sl3516_init(void)
+{
+	return platform_add_devices(sata_devices, ARRAY_SIZE(sata_devices));
+}
+
+subsys_initcall(sl3516_init);
--- /dev/null
+++ b/arch/arm/mach-sl2312/time.c
@@ -0,0 +1,134 @@
+/*
+ *  linux/include/asm-arm/arch-epxa10db/time.h
+ *
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#include <linux/interrupt.h>
+#include <linux/irq.h>
+#include <asm/io.h>
+#include <asm/system.h>
+#include <asm/leds.h>
+#include <asm/arch/hardware.h>
+#include <asm/mach/time.h>
+#define TIMER_TYPE (volatile unsigned int*)
+#include <asm/arch/timer.h>
+// #define FIQ_PLUS     1
+
+
+/*
+ * IRQ handler for the timer
+ */
+static irqreturn_t sl2312_timer_interrupt(int irq, void *dev_id)
+{
+//        unsigned int led;
+	// ...clear the interrupt
+#ifdef FIQ_PLUS
+	*((volatile unsigned int *)FIQ_CLEAR(IO_ADDRESS(SL2312_INTERRUPT_BASE))) |= (unsigned int)(IRQ_TIMER1_MASK);
+#else
+	*((volatile unsigned int *)IRQ_CLEAR(IO_ADDRESS(SL2312_INTERRUPT_BASE))) |= (unsigned int)(IRQ_TIMER2_MASK);
+#endif
+
+#if 0
+        if(!(jiffies % HZ))
+        {
+            led = jiffies / HZ;
+//            printk("ticks %x \n", led);
+	    }
+	do_leds();
+	do_timer(regs);
+	do_profile(regs);
+#endif
+    timer_tick();
+    return IRQ_HANDLED;
+}
+
+static struct irqaction sl2312_timer_irq = {
+	.name		= "SL2312 Timer Tick",
+	.flags		= IRQF_DISABLED | IRQF_TIMER,
+	.handler	= sl2312_timer_interrupt,
+};
+
+unsigned long sl2312_gettimeoffset (void)
+{
+    return 0L;
+}
+
+/*
+ * Set up timer interrupt, and return the current time in seconds.
+ */
+void __init sl2312_time_init(void)
+{
+	// For clock rate adjusting
+	unsigned int tick_rate=0;
+
+#ifdef CONFIG_SL3516_ASIC
+	unsigned int clock_rate_base = 130000000;
+	unsigned int reg_v=0;
+
+	//--> Add by jason for clock adjust
+	reg_v = readl(IO_ADDRESS((SL2312_GLOBAL_BASE+GLOBAL_STATUS)));
+	reg_v >>= 15;
+	tick_rate = (clock_rate_base + (reg_v & 0x07)*10000000);
+
+	//  FPGA use AHB bus tick rate
+	printk("Bus: %dMHz",tick_rate/1000000);
+
+	tick_rate /= 6;				// APB bus run AHB*(1/6)
+
+	switch((reg_v>>3)&3){
+		case 0:	printk("(1/1)\n") ;
+					break;
+		case 1:	printk("(3/2)\n") ;
+					break;
+		case 2:	printk("(24/13)\n") ;
+					break;
+		case 3:	printk("(2/1)\n") ;
+					break;
+	}
+	//<--
+#else
+	printk("Bus: %dMHz(1/1)\n",CLOCK_TICK_RATE/1000000);		// FPGA use 20MHz
+	tick_rate = CLOCK_TICK_RATE;
+#endif
+
+
+	/*
+	 * Make irqs happen for the system timer
+	 */
+	// initialize timer interrupt
+	// low active and edge trigger
+#ifdef FIQ_PLUS
+	*((volatile unsigned int *)FIQ_TMODE(IO_ADDRESS(SL2312_INTERRUPT_BASE))) |= (unsigned int)(IRQ_TIMER1_MASK);
+	*((volatile unsigned int *)FIQ_LEVEL(IO_ADDRESS(SL2312_INTERRUPT_BASE))) |= (unsigned int)(IRQ_TIMER1_MASK);
+	setup_irq(IRQ_TIMER1, &sl2312_timer_irq);
+	/* Start the timer */
+	*TIMER_COUNT(IO_ADDRESS(SL2312_TIMER1_BASE))=(unsigned int)(tick_rate/HZ);
+	*TIMER_LOAD(IO_ADDRESS(SL2312_TIMER1_BASE))=(unsigned int)(tick_rate/HZ);
+	*TIMER_CR(IO_ADDRESS(SL2312_TIMER1_BASE))=(unsigned int)(TIMER_1_CR_ENABLE_MSK|TIMER_1_CR_INT_MSK);
+#else
+	*((volatile unsigned int *)IRQ_TMODE(IO_ADDRESS(SL2312_INTERRUPT_BASE))) |= (unsigned int)(IRQ_TIMER2_MASK);
+	*((volatile unsigned int *)IRQ_TLEVEL(IO_ADDRESS(SL2312_INTERRUPT_BASE))) |= (unsigned int)(IRQ_TIMER2_MASK);
+	setup_irq(IRQ_TIMER2, &sl2312_timer_irq);
+	/* Start the timer */
+	*TIMER_COUNT(IO_ADDRESS(SL2312_TIMER2_BASE))=(unsigned int)(tick_rate/HZ);
+	*TIMER_LOAD(IO_ADDRESS(SL2312_TIMER2_BASE))=(unsigned int)(tick_rate/HZ);
+	*TIMER_CR(IO_ADDRESS(SL2312_TIMER1_BASE))=(unsigned int)(TIMER_2_CR_ENABLE_MSK|TIMER_2_CR_INT_MSK);
+#endif
+
+}
+
+
--- /dev/null
+++ b/arch/arm/mach-sl2312/xor.c
@@ -0,0 +1,1200 @@
+/*
+ * arch/arm/mach-sl2312/xor.c
+ *
+ * Support functions for the Gemini Soc. This is
+ * a HW XOR unit that is specifically designed for use with RAID5
+ * applications.  This driver provides an interface that is used by
+ * the Linux RAID stack.
+ *
+ * Original Author: Jason Lee<jason@storlink.com.tw>
+ *
+ * Contributors:Sanders<sanders@storlink.com.tw>
+ 				Jason Lee<jason@storlink.com.tw>
+ *
+ *
+ * Maintainer: Jason Lee<jason@storlink.com.tw>
+ *
+ * Copyright (C) 2005 Storlink Corporation
+ *
+ * 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.
+ *
+ *
+ * History:	(06/25/2005, DJ) Initial Creation
+ *
+ *	Versing 1.0.0	Initial version
+ */
+
+#include <linux/types.h>
+#include <linux/init.h>
+#include <linux/sched.h>
+#include <linux/spinlock.h>
+#include <linux/slab.h>
+#include <linux/errno.h>
+#include <linux/interrupt.h>
+#include <linux/sched.h>
+#include <linux/wait.h>
+#include <linux/list.h>
+#include <linux/pci.h>
+#include <linux/delay.h>
+#include <linux/dma-mapping.h>
+#include <linux/mm.h>
+#include <asm/irq.h>
+#include <asm/delay.h>
+#include <asm/uaccess.h>
+#include <asm/cacheflush.h>
+#include <asm/hardware.h>
+#include <asm/arch/xor.h>
+#include <asm/pci.h>
+#include <linux/version.h>
+
+/*
+ * pick up local definitions
+ */
+#define XOR_SW_FILL_IN
+#include "hw_xor.h"
+
+
+//#define XOR_DEBUG
+//#define XOR_TEST	1
+#ifdef XOR_TEST
+#define TEST_ITERATION 1000
+#define SPIN_WAIT	1
+#endif
+#ifdef XOR_DEBUG
+#define DPRINTK(s, args...) printk("Gemini XOR: " s "\n", ## args)
+#define DENTER() DPRINTK("Entered...\n");
+#define DEXIT() DPRINTK("Exited...\n");
+#else
+#define DPRINTK(s, args...)
+#define DENTER()
+#define DEXIT()
+#endif
+
+//#define SPIN_WAIT
+
+/* globals */
+static RAID_T tp;
+static RAID_TXDMA_CTRL_T 	txdma_ctrl;
+RAID_RXDMA_CTRL_T			rxdma_ctrl;
+
+//#ifndef SPIN_WAIT
+static spinlock_t	    raid_lock;
+//#endif
+
+static unsigned int     tx_desc_virtual_base;
+static unsigned int     rx_desc_virtual_base;
+RAID_DESCRIPTOR_T	*tx_desc_ptr;
+RAID_DESCRIPTOR_T	*rx_desc_ptr;
+
+/* static prototypes */
+#define DMA_MALLOC(size,handle)		pci_alloc_consistent(NULL,size,handle)
+#define DMA_MFREE(mem,size,handle)	pci_free_consistent(NULL,size,mem,handle)
+
+static int gemini_xor_init_desc(void);
+
+static unsigned int raid_read_reg(unsigned int offset)
+{
+    unsigned int    reg_val;
+
+    reg_val = readl(RAID_BASE_ADDR + offset);
+	return (reg_val);
+}
+
+static void raid_write_reg(unsigned int offset,unsigned int data,unsigned int bit_mask)
+{
+	unsigned int reg_val;
+    unsigned int *addr;
+
+	reg_val = ( raid_read_reg(offset) & (~bit_mask) ) | (data & bit_mask);
+	addr = (unsigned int *)(RAID_BASE_ADDR + offset);
+    writel(reg_val,addr);
+	return;
+}
+
+#ifndef SPIN_WAIT
+__inline__ void xor_queue_descriptor(void)
+{
+	unsigned int flags,status=1;
+
+	DPRINTK("Going to sleep");
+
+	while(status){
+		yield();
+		//schedule();
+		spin_lock_irqsave(&raid_lock,flags);
+		status = tp.busy;
+		spin_unlock_irqrestore(&raid_lock, flags);
+	}
+//	tp.status = COMPLETE;
+	DPRINTK("woken up!");
+
+}
+#endif
+
+#ifdef SPIN_WAIT
+static void gemini_xor_isr(int d_n)
+#else
+#if LINUX_VERSION_CODE <= KERNEL_VERSION(2,4,28)
+static void gemini_xor_isr(int irq, void *dev_id, struct pt_regs *regs)
+#elif LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
+static irqreturn_t gemini_xor_isr(int irq, void *dev_instance, struct pt_regs *regs)
+#endif
+#endif
+{
+
+	unsigned int err;
+	RAID_DMA_STATUS_T 	dma_status;
+//	RAID_DESCRIPTOR_T *rdesc,*tdesc;
+//	unsigned int *paddr;
+
+	dma_status.bits32 = raid_read_reg(RAID_DMA_STATUS);
+#ifdef SPIN_WAIT
+	while( (dma_status.bits32& (1<<31) ) ==0 ){
+		udelay(1);
+		dma_status.bits32 = raid_read_reg(RAID_DMA_STATUS);
+	}
+
+/*	tdesc = tp.tx_first_desc;
+	rdesc = tp.rx_first_desc;
+	for(d_n;d_n>0;d_n--){
+		if( tdesc->func_ctrl.bits.own == DMA ){
+			paddr = tdesc;
+			printk("error tx desc:0x%x\n",*paddr++);
+			printk("error tx desc:0x%x\n",*paddr++);
+			printk("error tx desc:0s%x\n",*paddr++);
+			printk("error tx desc:0x%x\n",*paddr);
+			while(1);
+		}
+		tdesc = (RAID_DESCRIPTOR_T *)((tdesc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+	}
+
+	if( rdesc->func_ctrl.bits.own == DMA ){
+		paddr = rdesc;
+		printk("error rx desc:0x%x\n",*paddr++);
+		printk("error rx desc:0x%x\n",*paddr++);
+		printk("error rx desc:0s%x\n",*paddr++);
+		printk("error rx desc:0x%x\n",*paddr);
+		while(1);
+	}
+*/
+#endif
+
+	if(dma_status.bits32 & ((1<<31)|(1<<26))){
+		// if no bug , we can turn off rx finish interrupt
+		dma_status.bits32 = raid_read_reg(RAID_DMA_STATUS);
+		err = raid_read_reg(RAID_DMA_DEVICE_ID);
+		tp.busy = 0;
+
+		if(err&0x00FF0000){
+			tp.status = ERROR;
+			printk("XOR:<HW>%s error code %x\n",(err&0x00F00000)?"tx":"rx",err);
+
+#if LINUX_VERSION_CODE <= KERNEL_VERSION(2,4,28)
+			return ;
+#elif LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
+#ifndef SPIN_WAIT
+			return IRQ_RETVAL(IRQ_HANDLED);
+#endif
+#endif
+		}
+		// 16~19 rx error code
+		// 20~23 tx error codd
+
+		dma_status.bits.tsFinishI = 1;
+		dma_status.bits.rsFinishI = 1;
+		raid_write_reg(RAID_DMA_STATUS, dma_status.bits32,0x84000000);	// clear INT
+
+//		printk("xor %d\n",d_n);
+#if LINUX_VERSION_CODE <= KERNEL_VERSION(2,4,28)
+			return ;
+#elif LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
+#ifndef SPIN_WAIT
+			return IRQ_RETVAL(IRQ_HANDLED);
+#endif
+#endif
+	}
+
+	#if LINUX_VERSION_CODE <= KERNEL_VERSION(2,4,28)
+		return ;
+	#elif LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
+	#ifndef SPIN_WAIT
+		printk("XOR: DMA status register(0x%8x)\n",dma_status.bits32);
+		return IRQ_RETVAL(IRQ_HANDLED);
+	#endif
+	#endif
+}
+
+void
+xor_gemini_2(unsigned long bytes, unsigned long *p1, unsigned long *p2)
+{
+	int status=0;
+	unsigned int flags;
+
+	if(bytes > (1<<(SRAM_PAR_SIZE+11))){
+		printk("XOR: out of SRAM partition!![0x%x]\n",(unsigned int)bytes);
+	}
+
+	spin_lock_irqsave(&raid_lock,flags);
+	while(tp.status != COMPLETE){
+		spin_unlock_irqrestore(&raid_lock, flags);
+		//printk("XOR yield2\n");
+#ifdef XOR_SW_FILL_IN
+		xor_arm4regs_2(bytes,p1,p2);
+		return ;
+#else
+		yield();
+#endif
+	}
+	spin_unlock_irqrestore(&raid_lock, flags);
+	tp.status = RUNNING;
+
+	// flush the cache to memory before H/W XOR touches them
+	consistent_sync(p1, bytes, DMA_BIDIRECTIONAL);
+	consistent_sync(p2, bytes, DMA_TO_DEVICE);
+
+
+	tp.tx_desc = tp.tx_first_desc;
+	tp.rx_desc = tp.rx_first_desc;
+	if((tp.tx_desc->func_ctrl.bits.own == CPU)/*&&(tp.rx_desc->func_ctrl.bits.own == DMA)*/){
+		// prepare tx descript
+		raid_write_reg(RAID_FCHDMA_CURR_DESC,(unsigned int)tp.tx_desc-tx_desc_virtual_base,0xffffffff);
+		tp.tx_desc->buf_addr = (unsigned int)__pa(p1);		// physical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 2;			// first descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00020000;
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+		wmb();
+    	tp.tx_desc = tp.tx_cur_desc;
+    	tp.tx_desc->buf_addr = (unsigned int)__pa(p2);		// pysical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 1;			// last descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00010000;
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_desc->next_desc_addr.bits32 = 0x0000000b;// end of descript
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);							// keep last descript
+
+    	wmb();
+    	// prepare rx descript
+    	raid_write_reg(RAID_STRDMA_CURR_DESC,(unsigned int)tp.rx_desc-rx_desc_virtual_base,0xFFFFFFFf);
+    	tp.rx_desc->buf_addr = (unsigned int)__pa(p1);
+    	tp.rx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+    	tp.rx_desc->flg_status.bits32 = 0;				// link data from XOR
+//    	tp.rx_cur_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.rx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.rx_desc->next_desc_addr.bits32 = 0x0000000b;// end of descript
+
+	}
+	else{
+	 	/* no free tx descriptor */
+	 	printk("XOR:no free tx descript");
+		return ;
+	}
+
+	// change status
+//	tp.status = RUNNING;
+	status = tp.busy = 1;
+
+	// start tx DMA
+	rxdma_ctrl.bits.rd_start = 1;
+	// start rx DMA
+	txdma_ctrl.bits.td_start = 1;
+
+	raid_write_reg(RAID_FCHDMA_CTRL, txdma_ctrl.bits32,0x80000000);
+	raid_write_reg(RAID_STRDMA_CTRL, rxdma_ctrl.bits32,0x80000000);
+
+#ifdef SPIN_WAIT
+	gemini_xor_isr(2);
+#else
+	xor_queue_descriptor();
+#endif
+
+	tp.tx_desc->next_desc_addr.bits32 = ((unsigned long)tp.tx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*2) ;
+	tp.status = COMPLETE;
+//	tp.rx_desc->next_desc_addr.bits32 = ((unsigned long)tp.rx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*1) ;
+//	tp.rx_desc = tp.rx_first_desc ;
+//	tp.rx_desc->func_ctrl.bits.own = DMA;
+
+}
+
+void
+xor_gemini_3(unsigned long bytes, unsigned long *p1, unsigned long *p2,
+		unsigned long *p3)
+{
+	int status=0;
+	unsigned int flags;
+
+	if(bytes > (1<<(SRAM_PAR_SIZE+11))){
+		printk("XOR: out of SRAM partition!![0x%x]\n",(unsigned int)bytes);
+	}
+
+	spin_lock_irqsave(&raid_lock,flags);
+	if(tp.status != COMPLETE){
+		spin_unlock_irqrestore(&raid_lock, flags);
+		//printk("XOR yield3\n");
+#ifdef XOR_SW_FILL_IN
+		xor_arm4regs_3(bytes,p1,p2,p3);
+		return;
+#else
+		yield();
+#endif
+	}
+	spin_unlock_irqrestore(&raid_lock, flags);
+	tp.status = RUNNING;
+
+	// flush the cache to memory before H/W XOR touches them
+	consistent_sync(p1, bytes, DMA_BIDIRECTIONAL);
+	consistent_sync(p2, bytes, DMA_TO_DEVICE);
+	consistent_sync(p3, bytes, DMA_TO_DEVICE);
+
+	tp.tx_desc = tp.tx_first_desc;
+	tp.rx_desc = tp.rx_first_desc;
+	if((tp.tx_desc->func_ctrl.bits.own == CPU)/*&&(tp.rx_desc->func_ctrl.bits.own == DMA)*/){
+		// prepare tx descript
+		raid_write_reg(RAID_FCHDMA_CURR_DESC,(unsigned int)tp.tx_desc-tx_desc_virtual_base,0xffffffff);
+		tp.tx_desc->buf_addr = (unsigned int)__pa(p1);		// physical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 2;			// first descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00020000;
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+
+    	tp.tx_desc = tp.tx_cur_desc;
+    	tp.tx_desc->buf_addr = (unsigned int)__pa(p2);		// pysical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 0;			// first descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x0000000;
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+
+    	tp.tx_desc = tp.tx_cur_desc;
+    	tp.tx_desc->buf_addr = (unsigned int)__pa(p3);		// pysical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 1;			// last descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00010000;
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_desc->next_desc_addr.bits32 = 0x0000000b;// end of descript
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);							// keep last descript
+
+    	// prepare rx descript
+    	raid_write_reg(RAID_STRDMA_CURR_DESC,(unsigned int)tp.rx_desc-rx_desc_virtual_base,0xFFFFFFFf);
+    	tp.rx_desc->buf_addr = (unsigned int)__pa(p1);
+    	tp.rx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+    	tp.rx_desc->flg_status.bits32 = 0;				// link data from XOR
+//    	tp.rx_cur_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.rx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.rx_desc->next_desc_addr.bits32 = 0x0000000b;// end of descript
+
+	}
+	else{
+	 	/* no free tx descriptor */
+	 	printk("XOR:no free tx descript \n");
+		return ;
+	}
+
+	// change status
+//	tp.status = RUNNING;
+	status = tp.busy = 1;
+
+	// start tx DMA
+	rxdma_ctrl.bits.rd_start = 1;
+	// start rx DMA
+	txdma_ctrl.bits.td_start = 1;
+	wmb();
+	raid_write_reg(RAID_FCHDMA_CTRL, txdma_ctrl.bits32,0x80000000);
+	raid_write_reg(RAID_STRDMA_CTRL, rxdma_ctrl.bits32,0x80000000);
+
+#ifdef SPIN_WAIT
+	gemini_xor_isr(3);
+#else
+	xor_queue_descriptor();
+#endif
+	tp.tx_desc->next_desc_addr.bits32 = ((unsigned long)tp.tx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*3) | 0x0B;
+	tp.status = COMPLETE;
+//	tp.rx_desc->next_desc_addr.bits32 = ((unsigned long)tp.rx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*1) | 0x0B;
+	//tp.rx_desc = tp.rx_first_desc ;
+//	tp.rx_desc->func_ctrl.bits.own = DMA;
+
+}
+
+void
+xor_gemini_4(unsigned long bytes, unsigned long *p1, unsigned long *p2,
+		unsigned long *p3, unsigned long *p4)
+{
+	int status=0;
+	unsigned int flags;
+
+	if(bytes > (1<<(SRAM_PAR_SIZE+11))){
+		printk("XOR: out of SRAM partition!![0x%x]\n",(unsigned int)bytes);
+	}
+
+	spin_lock_irqsave(&raid_lock,flags);
+	if(tp.status != COMPLETE){
+		spin_unlock_irqrestore(&raid_lock, flags);
+		//printk("S\n");
+#ifdef XOR_SW_FILL_IN
+		xor_arm4regs_4(bytes,p1,p2,p3,p4);
+		return;
+#else
+		msleep(1);
+		yield();
+#endif
+	}
+	spin_unlock_irqrestore(&raid_lock, flags);
+
+	tp.status = RUNNING;
+
+	// flush the cache to memory before H/W XOR touches them
+	consistent_sync(p1, bytes, DMA_BIDIRECTIONAL);
+	consistent_sync(p2, bytes, DMA_TO_DEVICE);
+	consistent_sync(p3, bytes, DMA_TO_DEVICE);
+	consistent_sync(p4, bytes, DMA_TO_DEVICE);
+
+	tp.tx_desc = tp.tx_first_desc;
+	tp.rx_desc = tp.rx_first_desc;
+	if((tp.tx_desc->func_ctrl.bits.own == CPU)/*&&(tp.rx_desc->func_ctrl.bits.own == DMA)*/){
+		// prepare tx descript
+		raid_write_reg(RAID_FCHDMA_CURR_DESC,(unsigned int)tp.tx_desc-tx_desc_virtual_base,0xffffffff);
+		tp.tx_desc->buf_addr = (unsigned int)__pa(p1);		// physical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 2;			// first descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00020000;
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+
+    	tp.tx_desc = tp.tx_cur_desc;
+    	tp.tx_cur_desc->buf_addr = (unsigned int)__pa(p2);		// pysical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 0;			// first descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00000000;
+    	tp.tx_cur_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+
+    	tp.tx_desc = tp.tx_cur_desc;
+    	tp.tx_desc->buf_addr = (unsigned int)__pa(p3);		// pysical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 0;			// first descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00000000;
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+
+
+    	tp.tx_desc = tp.tx_cur_desc;
+    	tp.tx_desc->buf_addr = (unsigned int)__pa(p4);		// pysical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 1;			// last descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00010000;
+//    	tp.tx_cur_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_desc->next_desc_addr.bits32 = 0x0000000b;// end of descript
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);							// keep last descript
+
+    	// prepare rx descript
+    	raid_write_reg(RAID_STRDMA_CURR_DESC,(unsigned int)tp.rx_desc-rx_desc_virtual_base,0xFFFFFFFF);
+    	tp.rx_desc->buf_addr = (unsigned int)__pa(p1);
+    	tp.rx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+    	tp.rx_desc->flg_status.bits32 = 0;				// link data from XOR
+//    	tp.rx_cur_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.rx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.rx_desc->next_desc_addr.bits32 = 0x0000000b;// end of descript
+
+	}
+	else{
+	 	/* no free tx descriptor */
+	 	printk("XOR:no free tx descript");
+		return ;
+	}
+
+	// change status
+//	tp.status = RUNNING;
+	status = tp.busy = 1;
+
+	// start tx DMA
+	rxdma_ctrl.bits.rd_start = 1;
+	// start rx DMA
+	txdma_ctrl.bits.td_start = 1;
+	wmb();
+	raid_write_reg(RAID_FCHDMA_CTRL, txdma_ctrl.bits32,0x80000000);
+	raid_write_reg(RAID_STRDMA_CTRL, rxdma_ctrl.bits32,0x80000000);
+
+#ifdef SPIN_WAIT
+	gemini_xor_isr(4);
+#else
+	xor_queue_descriptor();
+#endif
+
+	tp.tx_desc->next_desc_addr.bits32 = ((unsigned long)tp.tx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*4) | 0x0B;
+	tp.status = COMPLETE;
+//	tp.rx_desc->next_desc_addr.bits32 = ((unsigned long)tp.rx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*1) | 0x0B;
+	//tp.rx_desc = tp.rx_first_desc ;
+//	tp.rx_desc->func_ctrl.bits.own = DMA;
+
+}
+
+void
+xor_gemini_5(unsigned long bytes, unsigned long *p1, unsigned long *p2,
+		unsigned long *p3, unsigned long *p4, unsigned long *p5)
+{
+
+	int status=0;
+	unsigned int flags;
+
+
+	if(bytes > (1<<(SRAM_PAR_SIZE+11))){
+		printk("XOR: out of SRAM partition!![0x%x]\n",(unsigned int)bytes);
+	}
+
+	spin_lock_irqsave(&raid_lock,flags);
+	while(tp.status != COMPLETE){
+		spin_unlock_irqrestore(&raid_lock, flags);
+		//printk("XOR yield5\n");
+#ifdef XOR_SW_FILL_IN
+		xor_arm4regs_5(bytes,p1,p2,p3,p4,p5);
+		return;
+#else
+		msleep(1);
+		yield();
+#endif
+	}
+	spin_unlock_irqrestore(&raid_lock, flags);
+	tp.status = RUNNING;
+
+	// flush the cache to memory before H/W XOR touches them
+	consistent_sync(p1, bytes, DMA_BIDIRECTIONAL);
+	consistent_sync(p2, bytes, DMA_TO_DEVICE);
+	consistent_sync(p3, bytes, DMA_TO_DEVICE);
+	consistent_sync(p4, bytes, DMA_TO_DEVICE);
+	consistent_sync(p5, bytes, DMA_TO_DEVICE);
+
+	tp.tx_desc = tp.tx_first_desc;
+	tp.rx_desc = tp.rx_first_desc;
+	if((tp.tx_desc->func_ctrl.bits.own == CPU)/*&&(tp.rx_desc->func_ctrl.bits.own == DMA)*/){
+		// prepare tx descript
+		raid_write_reg(RAID_FCHDMA_CURR_DESC,(unsigned int)tp.tx_desc-tx_desc_virtual_base,0xffffffff);
+		tp.tx_desc->buf_addr = (unsigned int)__pa(p1);		// physical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 2;			// first descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00020000;
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	wmb();
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+
+    	tp.tx_desc = tp.tx_cur_desc;
+    	tp.tx_desc->buf_addr = (unsigned int)__pa(p2);		// pysical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 0;			// first descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00000000;
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	wmb();
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+
+    	tp.tx_desc = tp.tx_cur_desc;
+    	tp.tx_desc->buf_addr = (unsigned int)__pa(p3);		// pysical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 0;			// first descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00000000;
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	wmb();
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+
+		tp.tx_desc = tp.tx_cur_desc;
+    	tp.tx_desc->buf_addr = (unsigned int)__pa(p4);		// pysical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 0;			// first descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+		tp.tx_desc->flg_status.bits32 = 0x00000000;
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	wmb();
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+
+
+    	tp.tx_desc = tp.tx_cur_desc;
+    	tp.tx_desc->buf_addr = (unsigned int)__pa(p5);		// pysical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+//    	tp.tx_desc->flg_status.bits_cmd_status.bcc = 1;			// last descript
+//    	tp.tx_desc->flg_status.bits_cmd_status.mode = 0;		// only support XOR command
+//    	tp.tx_cur_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+		tp.tx_desc->flg_status.bits32 = 0x00010000;
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_desc->next_desc_addr.bits32 = 0x0000000b;// end of descript
+    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xfffffff0)+tx_desc_virtual_base);
+    	tp.tx_finished_desc = tp.tx_desc;								// keep last descript
+
+    	// prepare rx descript
+    	raid_write_reg(RAID_STRDMA_CURR_DESC,(unsigned int)tp.rx_desc-rx_desc_virtual_base,0xFFFFFFFF);
+    	tp.rx_desc->buf_addr = (unsigned int)__pa(p1);
+    	tp.rx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+    	tp.rx_desc->flg_status.bits32 = 0;				// link data from XOR
+//    	tp.rx_cur_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.rx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.rx_desc->next_desc_addr.bits32 = 0x0000000b;// end of descript
+
+	}
+	else{
+	 	/* no free tx descriptor */
+	 	printk("XOR:no free tx descript");
+		return ;
+	}
+
+	// change status
+//	tp.status = RUNNING;
+	status = tp.busy = 1;
+
+	// start tx DMA
+	rxdma_ctrl.bits.rd_start = 1;
+	// start rx DMA
+	txdma_ctrl.bits.td_start = 1;
+	wmb();
+	raid_write_reg(RAID_FCHDMA_CTRL, txdma_ctrl.bits32,0x80000000);
+	raid_write_reg(RAID_STRDMA_CTRL, rxdma_ctrl.bits32,0x80000000);
+
+#ifdef SPIN_WAIT
+	gemini_xor_isr(5);
+#else
+	xor_queue_descriptor();
+#endif
+
+	tp.tx_desc->next_desc_addr.bits32 = ((unsigned long)tp.tx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*5) | 0x0B;
+	tp.status = COMPLETE;
+//	tp.rx_desc->next_desc_addr.bits32 = ((unsigned long)tp.rx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*1) | 0x0B;
+	//tp.rx_desc = tp.rx_first_desc ;
+//	tp.rx_desc->func_ctrl.bits.own = DMA;
+
+}
+
+#ifdef XOR_TEST
+void
+raid_memset(unsigned int *p1, unsigned int pattern, unsigned int bytes)
+{
+	int status=0,i;
+
+	if(bytes > (1<<(SRAM_PAR_SIZE+11))){
+		printk("XOR: out of SRAM partition!![0x%x]\n",(unsigned int)bytes);
+	}
+
+	*p1 = pattern;
+
+	// flush the cache to memory before H/W XOR touches them
+	consistent_sync(p1, bytes, DMA_BIDIRECTIONAL);
+
+	while(tp.status != COMPLETE){
+		DPRINTK("XOR yield\n");
+		//schedule();
+		yield();
+	}
+	tp.status = RUNNING;
+
+	tp.tx_desc = tp.tx_first_desc;
+	tp.rx_desc = tp.rx_first_desc;
+	if((tp.tx_desc->func_ctrl.bits.own == CPU)/*&&(tp.rx_desc->func_ctrl.bits.own == DMA)*/){
+		// prepare tx descript
+		raid_write_reg(RAID_FCHDMA_CURR_DESC,(unsigned int)tp.tx_desc-tx_desc_virtual_base,0xFFFFFFFF);
+		tp.tx_desc->buf_addr = (unsigned int)__pa(p1);		// physical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = 4;    		/* total frame byte count */
+    	tp.tx_desc->flg_status.bits_cmd_status.bcc = bytes;			// bytes to fill
+    	tp.tx_desc->flg_status.bits_cmd_status.mode = CMD_FILL;		// only support memory FILL command
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_desc->next_desc_addr.bits32 = 0x0000000b;
+//    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xFFFFFFF0)+tx_desc_virtual_base);
+
+    	// prepare rx descript
+    	raid_write_reg(RAID_STRDMA_CURR_DESC,(unsigned int)tp.rx_desc-rx_desc_virtual_base,0xFFFFFFFF);
+    	tp.rx_desc->buf_addr = (unsigned int)__pa(p1);
+    	tp.rx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+    	tp.rx_desc->flg_status.bits32 = 0;				// link data from XOR
+    	tp.rx_cur_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.rx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+//    	tp.rx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.rx_cur_desc->next_desc_addr.bits32 & 0xfffffff0)+rx_desc_virtual_base);
+    	tp.rx_desc->next_desc_addr.bits32 = 0x0000000b;// end of descript
+    	tp.rx_finished_desc = tp.rx_desc;
+
+	}
+	else{
+	 	/* no free tx descriptor */
+	 	printk("XOR:no free tx descript");
+		return ;
+	}
+
+	// change status
+	//tp.status = RUNNING;
+	status = tp.busy = 1;
+
+	// start tx DMA
+	rxdma_ctrl.bits.rd_start = 1;
+	// start rx DMA
+	txdma_ctrl.bits.td_start = 1;
+
+	raid_write_reg(RAID_FCHDMA_CTRL, txdma_ctrl.bits32,0x80000000);
+	raid_write_reg(RAID_STRDMA_CTRL, rxdma_ctrl.bits32,0x80000000);
+
+#ifdef SPIN_WAIT
+	gemini_xor_isr(2);
+#else
+	xor_queue_descriptor();
+#endif
+
+	for(i=1; i<(bytes/sizeof(int)); i++) {
+		if(p1[0]!=p1[i]){
+			printk("pattern set error!\n");
+			while(1);
+		}
+	}
+
+	tp.tx_desc->next_desc_addr.bits32 = ((unsigned long)tp.tx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*1) ;
+	tp.status = COMPLETE;
+//	tp.rx_desc->next_desc_addr.bits32 = ((unsigned long)tp.rx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*1) ;
+	//tp.rx_desc = tp.rx_first_desc ;
+//	tp.rx_desc->func_ctrl.bits.own = DMA;
+
+}
+#endif
+
+void
+raid_memcpy(unsigned int *to, unsigned int *from, unsigned int bytes)
+{
+	int status=0,i;
+
+	if(bytes > (1<<(SRAM_PAR_SIZE+11))){
+		printk("XOR: out of SRAM partition!![0x%x]\n",(unsigned int)bytes);
+	}
+
+	// flush the cache to memory before H/W XOR touches them
+	consistent_sync(to, bytes, DMA_BIDIRECTIONAL);
+	consistent_sync(from,bytes, DMA_TO_DEVICE);
+
+	while(tp.status != COMPLETE){
+		DPRINTK("XOR yield\n");
+		//schedule();
+		yield();
+	}
+	tp.status = RUNNING;
+
+	tp.tx_desc = tp.tx_first_desc;
+	tp.rx_desc = tp.rx_first_desc;
+	if((tp.tx_desc->func_ctrl.bits.own == CPU)/*&&(tp.rx_desc->func_ctrl.bits.own == DMA)*/){
+		// prepare tx descript
+		raid_write_reg(RAID_FCHDMA_CURR_DESC,(unsigned int)tp.tx_desc-tx_desc_virtual_base,0xFFFFFFFF);
+		tp.tx_desc->buf_addr = (unsigned int)__pa(from);		// physical address
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+    	tp.tx_desc->flg_status.bits32 = CMD_CPY;		// only support memory FILL command
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_desc->next_desc_addr.bits32 = 0x0000000b;
+//    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xFFFFFFF0)+tx_desc_virtual_base);
+
+    	// prepare rx descript
+    	raid_write_reg(RAID_STRDMA_CURR_DESC,(unsigned int)tp.rx_desc-rx_desc_virtual_base,0xFFFFFFFF);
+    	tp.rx_desc->buf_addr = (unsigned int)__pa(to);
+    	tp.rx_desc->func_ctrl.bits.buffer_size = bytes;    		/* total frame byte count */
+    	tp.rx_desc->flg_status.bits32 = 0;				// link data from XOR
+    	tp.rx_cur_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.rx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+//    	tp.rx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.rx_cur_desc->next_desc_addr.bits32 & 0xfffffff0)+rx_desc_virtual_base);
+    	tp.rx_desc->next_desc_addr.bits32 = 0x0000000b;// end of descript
+
+	}
+	else{
+	 	/* no free tx descriptor */
+	 	printk("XOR:no free tx descript");
+		return ;
+	}
+
+	// change status
+	//tp.status = RUNNING;
+	status = tp.busy = 1;
+
+	// start tx DMA
+	rxdma_ctrl.bits.rd_start = 1;
+	// start rx DMA
+	txdma_ctrl.bits.td_start = 1;
+
+	raid_write_reg(RAID_FCHDMA_CTRL, txdma_ctrl.bits32,0x80000000);
+	raid_write_reg(RAID_STRDMA_CTRL, rxdma_ctrl.bits32,0x80000000);
+
+#ifdef SPIN_WAIT
+	gemini_xor_isr(2);
+#else
+	xor_queue_descriptor();
+#endif
+
+#ifdef XOR_TEST
+	for(i=1; i<(bytes/sizeof(int)); i++) {
+		if(to[i]!=from[i]){
+			printk("pattern check error!\n");
+			printk("offset=0x%x p1=%x p2=%x\n",i*4,to[i],from[i]);
+			while(1);
+		}
+	}
+#endif
+
+	tp.tx_desc->next_desc_addr.bits32 = ((unsigned long)tp.tx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*1) ;
+	tp.status = COMPLETE;
+//	tp.rx_desc->next_desc_addr.bits32 = ((unsigned long)tp.rx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*1) ;
+	//tp.rx_desc = tp.rx_first_desc ;
+//	tp.rx_desc->func_ctrl.bits.own = DMA;
+
+}
+EXPORT_SYMBOL(raid_memcpy);
+
+#ifdef XOR_TEST
+int
+raid_memchk(unsigned int *p1, unsigned int pattern, unsigned int bytes)
+{
+	int status=0;
+	RAID_DMA_STATUS_T 	dma_status;
+
+	if(bytes > (1<<(SRAM_PAR_SIZE+11))){
+		printk("XOR: out of SRAM partition!![0x%x]\n",(unsigned int)bytes);
+	}
+
+	status = ((pattern&0xFFFF)%bytes )/4;
+	p1[status] = pattern;
+
+	while(tp.status != COMPLETE){
+		DPRINTK("XOR yield\n");
+		//schedule();
+		yield();
+	}
+	tp.status = RUNNING;
+
+	// flush the cache to memory before H/W XOR touches them
+	consistent_sync(p1, bytes, DMA_BIDIRECTIONAL);
+
+	tp.tx_desc = tp.tx_first_desc;
+	if((tp.tx_desc->func_ctrl.bits.own == CPU)/*&&(tp.rx_desc->func_ctrl.bits.own == DMA)*/){
+		// prepare tx descript
+		raid_write_reg(RAID_FCHDMA_CURR_DESC,(unsigned int)tp.tx_desc-tx_desc_virtual_base,0xFFFFFFFF);
+		tp.tx_desc->buf_addr = (unsigned int)__pa(p1);		// physical address
+    	tp.tx_desc->func_ctrl.bits.raid_ctrl_status = 0;
+    	tp.tx_desc->func_ctrl.bits.buffer_size = bytes ;    		/* total frame byte count */
+    	tp.tx_desc->flg_status.bits32 = CMD_CHK;		// only support memory FILL command
+    	tp.tx_desc->next_desc_addr.bits.sof_eof = 0x03;          /*only one descriptor*/
+    	tp.tx_desc->func_ctrl.bits.own = DMA;	        		/* set owner bit */
+    	tp.tx_desc->next_desc_addr.bits32 = 0x0000000b;
+//    	tp.tx_cur_desc = (RAID_DESCRIPTOR_T *)((tp.tx_desc->next_desc_addr.bits32 & 0xFFFFFFF0)+tx_desc_virtual_base);
+
+	}
+	else{
+	 	/* no free tx descriptor */
+	 	printk("XOR:no free tx descript");
+		return -1;
+	}
+
+	// change status
+	//tp.status = RUNNING;
+	status = tp.busy = 1;
+
+	// start tx DMA
+	txdma_ctrl.bits.td_start = 1;
+
+	raid_write_reg(RAID_FCHDMA_CTRL, txdma_ctrl.bits32,0x80000000);
+//	raid_write_reg(RAID_STRDMA_CTRL, rxdma_ctrl.bits32,0x80000000);
+
+#ifdef SPIN_WAIT
+	gemini_xor_isr(2);
+#else
+	xor_queue_descriptor();
+#endif
+
+//	dma_status.bits32 = raid_read_reg(RAID_DMA_STATUS);
+//	if (dma_status.bits32 & (1<<15))	{
+
+	if((tp.tx_first_desc->func_ctrl.bits.raid_ctrl_status & 0x2)) {
+		status = 1;
+//		raid_write_reg(RAID_DMA_STATUS,0x00008000,0x00080000);
+	}
+	else{
+		status = 0;
+	}
+
+	tp.tx_desc->next_desc_addr.bits32 = ((unsigned long)tp.tx_first_desc - tx_desc_virtual_base + sizeof(RAID_DESCRIPTOR_T)*1) ;
+	tp.status = COMPLETE;
+//	tp.rx_desc->func_ctrl.bits.own = DMA;
+	return status ;
+}
+#endif
+
+int __init gemini_xor_init(void)
+{
+	unsigned int res;
+	unsigned int *paddr1,*paddr2,*paddr3,i;
+	unsigned volatile char  *charact;
+	unsigned volatile short *two_char;
+	unsigned volatile int   *four_char;
+
+	// init descript
+	res = gemini_xor_init_desc();
+	if(res) {
+		printk("Init RAID Descript Fail!!\n");
+		return -res;
+	}
+
+	tp.device_name = "Gemini XOR Acceleration";
+
+	// request irq
+#ifndef SPIN_WAIT
+	res = request_irq(IRQ_RAID, gemini_xor_isr, SA_INTERRUPT, tp.device_name, NULL);
+#endif
+	if(res){
+		printk(KERN_ERR "%s: unable to request IRQ %d for "
+		       "HW XOR %d\n", tp.device_name, IRQ_RAID, res);
+		return -EBUSY;
+	}
+
+#ifdef XOR_TEST
+
+RETEST:
+	paddr1 = kmalloc(0x1000,GFP_KERNEL);
+	paddr2 = kmalloc(0x1000,GFP_KERNEL);
+	paddr3 = kmalloc(0x1000,GFP_KERNEL);
+	for(i=0;i<TEST_ITERATION;i++) {
+		printk("XOR test round %d\n",i);
+		for(res=0;res<(0x1000)/sizeof(int);res++){		// prepare data pattern
+		 	paddr1[res]= readl(0xf62000ac);
+		 	paddr2[res]= readl(0xf62000ac);
+		}
+		for(res=0;res<0x1000/sizeof(int);res++){		// calculate xor by software
+			paddr3[res] = paddr1[res]^paddr2[res];
+		}
+		xor_gemini_2(0x1000,paddr1,paddr2);				// calculate xor by hw
+		for(res=0;res<0x1000/sizeof(int);res++){		// check error
+			if(paddr1[res]!=paddr3[res]){
+				printk("XOR ERROR\n");
+				printk("[%d][0x%x]=0x%x should be %x\n",res,&paddr1[res],paddr1[res],paddr3[res]);
+				while(1);
+			}
+		}
+	}
+	kfree(paddr1);
+	kfree(paddr2);
+	kfree(paddr3);
+
+
+	// memcpy test
+	paddr1 = kmalloc(0x4000,GFP_KERNEL);
+	for(i=0;i<TEST_ITERATION;i++) {
+		for(res=0;res<(0x4000)/sizeof(int);res++)
+		 	paddr1[res]= readl(0xf62000ac);
+
+		printk("MEMCOPY round %d\n",i);
+		paddr2 = kmalloc(0x4000,GFP_KERNEL);
+		raid_memcpy(paddr2,paddr1,0x4000);
+		kfree(paddr2);
+	}
+	kfree(paddr1);
+
+	// memset test
+	for(i=0;i<TEST_ITERATION;i++) {
+		raid_memset(paddr1,0xFFFFFFFF,0x4000);
+		res = readl(0xf62000ac);
+		printk("MEMFILL fill 0x%x round %d\n",res,i);
+		paddr1 = kmalloc(0x4000,GFP_KERNEL);
+		raid_memset(paddr1,res,0x4000);
+		raid_memset(paddr1,0x0,0x4000);
+		kfree(paddr1);
+	}
+
+	paddr1 = kmalloc(0x4000,GFP_KERNEL);
+	for(i=0;i<TEST_ITERATION;i++){
+		raid_memset(paddr1, i,0x4000);
+		printk("Pattern check same ? ");
+		res = raid_memchk(paddr1, i,0x4000);
+		printk("%s\n",res?"Fail":"OK");
+		if(res)	while(1);
+
+		printk("Pattern check diff ? ");
+		res = raid_memchk(paddr1,readl(0xf62000ac),0x4000);
+		printk("%s\n",res?"OK":"Fail");
+		if(!res)	while(1);
+	}
+	kfree(paddr1);
+
+	// SRAM test
+	raid_write_reg(RAID_PCR, 0,0x00000003);
+	for(i=0;i<TEST_ITERATION;i++) {
+		printk("SRAM test %d\n",i);
+		charact = 0xF7000000;
+		two_char = 0xF7000000;
+		four_char = 0xF7000000;
+		for(res=0;res<(16*1024)/sizeof(char);res++) {		// 8-bit access
+			*charact++ = (unsigned char)res;
+		}
+		charact = 0xF7000000;
+		for(res=0;res<(16*1024)/sizeof(char);res++) {
+			if(*charact++ != (unsigned char)res){
+				printk("SRAM data error(8)\n");
+				while(1);
+			}
+		}
+
+		for(res=0;res<(16*1024)/sizeof(short);res++) {		// 16-bit access
+			*two_char++ = (unsigned short)res;
+		}
+		two_char = 0xF7000000;
+		for(res=0;res<(16*1024)/sizeof(short);res++) {
+			if(*two_char++ != (unsigned short)res){
+				printk("SRAM data error(16)\n");
+				while(1);
+			}
+		}
+
+		for(res=0;res<(16*1024)/sizeof(int);res++) {		// 32-bit access
+			*four_char++ = (unsigned int)res;
+		}
+		four_char = 0xF7000000;
+		for(res=0;res<(16*1024)/sizeof(int);res++) {
+			if(*four_char++ != (unsigned int)res){
+				printk("SRAM data error(32)\n");
+				while(1);
+			}
+		}
+	}
+	raid_write_reg(RAID_PCR, SRAM_PAR_SIZE,0x00000003);
+
+#endif
+	return 0;
+}
+
+void __exit gemini_xor_exit(void)
+{
+	DMA_MFREE(tp.tx_desc, TX_DESC_NUM*sizeof(RAID_DESCRIPTOR_T),(unsigned int)tp.tx_desc_dma);
+	DMA_MFREE(tp.rx_desc, RX_DESC_NUM*sizeof(RAID_DESCRIPTOR_T),(unsigned int)tp.rx_desc_dma);
+	free_irq(IRQ_RAID, NULL);
+}
+
+
+static int gemini_xor_init_desc(void)
+{
+	unsigned int i;
+	dma_addr_t          tx_first_desc_dma;
+	dma_addr_t          rx_first_desc_dma;
+	RAID_DMA_STATUS_T 	dma_status;
+
+	printk("Initial RAID Descripter...\n");
+
+	tp.tx_desc = (RAID_DESCRIPTOR_T*)DMA_MALLOC(TX_DESC_NUM*sizeof(RAID_DESCRIPTOR_T),(dma_addr_t *)&tp.tx_desc_dma);
+    tx_desc_virtual_base = (unsigned int)tp.tx_desc - (unsigned int)tp.tx_desc_dma;
+    memset(tp.tx_desc,0x00,TX_DESC_NUM*sizeof(RAID_DESCRIPTOR_T));
+
+	tp.rx_desc = (RAID_DESCRIPTOR_T*)DMA_MALLOC(RX_DESC_NUM*sizeof(RAID_DESCRIPTOR_T),(dma_addr_t *)&tp.rx_desc_dma);
+    rx_desc_virtual_base = (unsigned int)tp.rx_desc - (unsigned int)tp.rx_desc_dma;
+    memset(tp.rx_desc,0x00,RX_DESC_NUM*sizeof(RAID_DESCRIPTOR_T));
+	printk("XOR:tx_desc = %08x\n",(unsigned int)tp.tx_desc);
+    printk("XOR:rx_desc = %08x\n",(unsigned int)tp.rx_desc);
+	printk("XOR:tx_desc_dma = %08x\n",(unsigned int)tp.tx_desc_dma);
+	printk("XOR:rx_desc_dma = %08x\n",(unsigned int)tp.rx_desc_dma);
+
+	if ((tp.tx_desc == NULL) || (tp.rx_desc == NULL)) {
+		if (tp.tx_desc)
+			DMA_MFREE(tp.tx_desc, TX_DESC_NUM*sizeof(RAID_DESCRIPTOR_T),(dma_addr_t)tp.tx_desc_dma);
+		if (tp.rx_desc)
+			DMA_MFREE(tp.rx_desc, RX_DESC_NUM*sizeof(RAID_DESCRIPTOR_T),(dma_addr_t)tp.rx_desc_dma);
+		return -ENOMEM;
+	}
+
+	tp.tx_cur_desc = tp.tx_desc;  /* virtual address */
+	tp.tx_finished_desc = tp.tx_desc; /* virtual address */
+	tx_first_desc_dma = (dma_addr_t)tp.tx_desc_dma; /* physical address */
+	for (i = 1; i < TX_DESC_NUM; i++) {
+		tp.tx_desc->func_ctrl.bits.own = CPU;
+		tp.tx_desc->func_ctrl.bits.buffer_size = 0;
+		tp.tx_desc_dma = tp.tx_desc_dma + sizeof(RAID_DESCRIPTOR_T);
+//		tp.tx_desc->next_desc_addr.bits32 = (unsigned int)tp.tx_desc_dma | 0x0B;
+		tp.tx_desc->next_desc_addr.bits32 = ((unsigned int)tx_first_desc_dma | 0x0B) + i*0x10;
+		tp.tx_desc = &tp.tx_desc[1];
+	}
+	tp.tx_desc->func_ctrl.bits.own = DMA;
+	tp.tx_desc->next_desc_addr.bits32 = (unsigned int)tx_first_desc_dma|0x0b;
+	tp.tx_desc = tp.tx_cur_desc;
+	tp.tx_desc_dma = (unsigned int*)tx_first_desc_dma;
+	tp.tx_first_desc = tp.tx_desc ;
+
+	tp.rx_cur_desc = tp.rx_desc;  /* virtual address */
+	tp.rx_finished_desc = tp.rx_desc; /* virtual address */
+	rx_first_desc_dma = (dma_addr_t)tp.rx_desc_dma; /* physical address */
+	for (i = 1; i < RX_DESC_NUM; i++) {
+		tp.rx_desc->func_ctrl.bits.own = DMA;
+		tp.rx_desc->func_ctrl.bits.buffer_size = 0;
+		tp.rx_desc_dma = tp.rx_desc_dma + sizeof(RAID_DESCRIPTOR_T);
+//		tp.rx_desc->next_desc_addr.bits32 = (unsigned int)tp.rx_desc_dma | 0x0B;
+		tp.rx_desc->next_desc_addr.bits32 = ((unsigned int)rx_first_desc_dma | 0x0B) + i*0x10;
+		tp.rx_desc = &tp.rx_desc[1];
+	}
+	tp.rx_desc->func_ctrl.bits.own = DMA;
+	tp.rx_desc->next_desc_addr.bits32 = rx_first_desc_dma|0x0b;
+	tp.rx_desc = tp.rx_cur_desc;
+	tp.rx_desc_dma = (unsigned int*)rx_first_desc_dma;
+	tp.rx_first_desc = tp.rx_desc ;
+	tp.busy = 0;
+	tp.status = COMPLETE;
+
+	// Partition SRAM size
+	raid_write_reg(RAID_PCR, SRAM_PAR_SIZE,0x00000003);
+
+	// config tx DMA controler
+	txdma_ctrl.bits32 = 0;
+	txdma_ctrl.bits.td_start = 0;
+	txdma_ctrl.bits.td_continue = 1;
+	txdma_ctrl.bits.td_chain_mode = 1;
+	txdma_ctrl.bits.td_prot = 0;
+	txdma_ctrl.bits.td_burst_size = 1;
+	txdma_ctrl.bits.td_bus = 3;
+	txdma_ctrl.bits.td_endian = 0;
+	txdma_ctrl.bits.td_finish_en = 1;
+	txdma_ctrl.bits.td_fail_en = 1;
+	txdma_ctrl.bits.td_perr_en = 1;
+	txdma_ctrl.bits.td_eod_en = 0;	// enable tx descript
+	txdma_ctrl.bits.td_eof_en = 0;
+	raid_write_reg(RAID_FCHDMA_CTRL, txdma_ctrl.bits32,0xFFFFFFFF);
+
+	// config rx DMA controler
+	rxdma_ctrl.bits32 = 0;
+	rxdma_ctrl.bits.rd_start = 0;
+	rxdma_ctrl.bits.rd_continue = 1;
+	rxdma_ctrl.bits.rd_chain_mode = 1;
+	rxdma_ctrl.bits.rd_prot = 0;
+	rxdma_ctrl.bits.rd_burst_size = 1;
+	rxdma_ctrl.bits.rd_bus = 3;
+	rxdma_ctrl.bits.rd_endian = 0;
+	rxdma_ctrl.bits.rd_finish_en = 0;
+	rxdma_ctrl.bits.rd_fail_en = 1;
+	rxdma_ctrl.bits.rd_perr_en = 1;
+	rxdma_ctrl.bits.rd_eod_en = 0;
+	rxdma_ctrl.bits.rd_eof_en = 0;
+	raid_write_reg(RAID_STRDMA_CTRL, rxdma_ctrl.bits32,0xFFFFFFFF);
+
+	// enable interrupt
+	dma_status.bits32 = 3;	// enable RpInt
+	raid_write_reg(RAID_DMA_STATUS, dma_status.bits32,0xFFFFFFFF);
+
+	return 0;
+}
+
+module_init(gemini_xor_init);
+module_exit(gemini_xor_exit);
+
--- a/arch/arm/mm/Kconfig
+++ b/arch/arm/mm/Kconfig
@@ -187,6 +187,26 @@ config CPU_ARM926T
 	  Say Y if you want support for the ARM926T processor.
 	  Otherwise, say N.
 
+###### for Storlink SoC ######
+config CPU_FA526
+	bool "FA526 processor"
+	depends on ARCH_SL2312
+	default y
+	select CPU_32v4
+	select CPU_ABRT_EV4
+	select CPU_CACHE_FA
+	select CPU_CACHE_VIVT
+	select CPU_CP15_MMU
+	select CPU_COPY_FA
+	select CPU_TLB_FA
+	select CPU_FA_BTB
+	help
+	  The FA526 is a version of the ARM9 compatible processor, but with smaller
+	  instruction and data caches. It is used in Storlink Sword device family.
+
+	  Say Y if you want support for the FA526 processor.
+	  Otherwise, say N.
+
 # ARM940T
 config CPU_ARM940T
 	bool "Support ARM940T processor" if ARCH_INTEGRATOR
@@ -461,6 +481,9 @@ config CPU_CACHE_VIVT
 config CPU_CACHE_VIPT
 	bool
 
+config CPU_CACHE_FA
+	bool
+
 if MMU
 # The copy-page model
 config CPU_COPY_V3
@@ -475,6 +498,12 @@ config CPU_COPY_V4WB
 config CPU_COPY_V6
 	bool
 
+config CPU_COPY_FA
+	bool
+
+config CPU_FA_BTB
+	bool
+
 # This selects the TLB model
 config CPU_TLB_V3
 	bool
@@ -534,6 +563,14 @@ config CPU_CP15_MPU
 config IO_36
 	bool
 
+config CPU_TLB_FA
+	bool
+	help
+	  //TODO
+	  Faraday ARM FA526 architecture, unified TLB with writeback cache
+	  and invalidate instruction cache entry. Branch target buffer is also
+	  supported.
+
 comment "Processor Features"
 
 config ARM_THUMB
@@ -600,7 +637,7 @@ config CPU_DCACHE_SIZE
 
 config CPU_DCACHE_WRITETHROUGH
 	bool "Force write through D-cache"
-	depends on (CPU_ARM740T || CPU_ARM920T || CPU_ARM922T || CPU_ARM925T || CPU_ARM926T || CPU_ARM940T || CPU_ARM946E || CPU_ARM1020) && !CPU_DCACHE_DISABLE
+	depends on (CPU_ARM740T || CPU_ARM920T || CPU_ARM922T || CPU_ARM925T || CPU_ARM926T || CPU_ARM940T || CPU_ARM946E || CPU_ARM1020 || CPU_FA526) && !CPU_DCACHE_DISABLE
 	default y if CPU_ARM925T
 	help
 	  Say Y here to use the data cache in writethrough mode. Unless you
--- a/arch/arm/mm/Makefile
+++ b/arch/arm/mm/Makefile
@@ -32,6 +32,7 @@ obj-$(CONFIG_CPU_CACHE_V4WT)	+= cache-v4
 obj-$(CONFIG_CPU_CACHE_V4WB)	+= cache-v4wb.o
 obj-$(CONFIG_CPU_CACHE_V6)	+= cache-v6.o
 obj-$(CONFIG_CPU_CACHE_V7)	+= cache-v7.o
+obj-$(CONFIG_CPU_CACHE_FA)	+= cache-fa.o
 
 obj-$(CONFIG_CPU_COPY_V3)	+= copypage-v3.o
 obj-$(CONFIG_CPU_COPY_V4WT)	+= copypage-v4wt.o
@@ -40,6 +41,7 @@ obj-$(CONFIG_CPU_COPY_V6)	+= copypage-v6
 obj-$(CONFIG_CPU_SA1100)	+= copypage-v4mc.o
 obj-$(CONFIG_CPU_XSCALE)	+= copypage-xscale.o
 obj-$(CONFIG_CPU_XSC3)		+= copypage-xsc3.o
+obj-$(CONFIG_CPU_COPY_FA)	+= copypage-fa.o
 
 obj-$(CONFIG_CPU_TLB_V3)	+= tlb-v3.o
 obj-$(CONFIG_CPU_TLB_V4WT)	+= tlb-v4.o
@@ -47,6 +49,7 @@ obj-$(CONFIG_CPU_TLB_V4WB)	+= tlb-v4wb.o
 obj-$(CONFIG_CPU_TLB_V4WBI)	+= tlb-v4wbi.o
 obj-$(CONFIG_CPU_TLB_V6)	+= tlb-v6.o
 obj-$(CONFIG_CPU_TLB_V7)	+= tlb-v7.o
+obj-$(CONFIG_CPU_TLB_FA)	+= tlb-fa.o
 
 obj-$(CONFIG_CPU_ARM610)	+= proc-arm6_7.o
 obj-$(CONFIG_CPU_ARM710)	+= proc-arm6_7.o
@@ -60,6 +63,7 @@ obj-$(CONFIG_CPU_ARM925T)	+= proc-arm925
 obj-$(CONFIG_CPU_ARM926T)	+= proc-arm926.o
 obj-$(CONFIG_CPU_ARM940T)	+= proc-arm940.o
 obj-$(CONFIG_CPU_ARM946E)	+= proc-arm946.o
+obj-$(CONFIG_CPU_FA526)		+= proc-fa526.o
 obj-$(CONFIG_CPU_ARM1020)	+= proc-arm1020.o
 obj-$(CONFIG_CPU_ARM1020E)	+= proc-arm1020e.o
 obj-$(CONFIG_CPU_ARM1022)	+= proc-arm1022.o
--- /dev/null
+++ b/arch/arm/mm/cache-fa.S
@@ -0,0 +1,400 @@
+/*
+ *  linux/arch/arm/mm/cache-fa.S
+ *
+ *  Copyright (C) 2005 Faraday Corp.
+ *
+ * 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.
+ *
+ *  Processors: FA520 FA526 FA626	
+ * 03/31/2005 :	Luke Lee created, modified from cache-v4wb.S
+ * 04/06/2005 :	1. Read CR0-1 and determine the cache size dynamically,
+ *		   to suit all Faraday CPU series
+ *	        2. Fixed all functions
+ * 04/08/2005 :	insert CONFIG_CPU_ICACHE_DISABLE and CONFIG_CPU_DCACHE_DISABLE
+ * 04/12/2005 :	TODO: make this processor dependent or a self-modifying code to 
+ *	        inline cache len/size info into the instructions, as reading cache 
+ *	        size and len info in memory could cause another cache miss.
+ * 05/05/2005 :	Modify fa_flush_user_cache_range to comply APCS.
+ * 05/19/2005 :	Adjust for boundary conditions.
+ */
+#include <linux/linkage.h>
+#include <linux/init.h>
+#include <asm/hardware.h>
+#include <asm/page.h>
+#include "proc-macros.S"
+
+#define CACHE_DLINESIZE	   16
+#ifdef CONFIG_SL3516_ASIC
+#define CACHE_DSIZE	   8192
+#else
+#define CACHE_DSIZE	   16384 
+#endif 
+#define CACHE_ILINESIZE	   16
+#define CACHE_ISIZE	   16384
+
+/* Luke Lee 04/06/2005 ins begin */
+/*
+ *	initialize_cache_info()
+ *
+ *	Automatic detection of DSIZE, DLEN, ISIZE, ILEN variables according to 
+ *	system register CR0-1
+ *	Destroyed register: r0, r1, r2, r3, ip
+ */
+	.align
+ENTRY(fa_initialize_cache_info)
+	mov	r3, #1				@ r3 always = 1
+	adr	ip, __fa_cache_ilen
+	
+	mrc	p15, 0, r0, c0, c0, 1
+	/* ILEN */
+	and	r1, r0, #3			@ bits [1:0]
+	add	r1, r1, #3			@ cache line size is at least 8 bytes (2^3)
+	mov	r2, r3, lsl r1			@ r2 = 1<<r1
+	str	r2, [ip], #4
+	/* ISIZE */
+	mov	r1, r0, lsr #6			@ bits [8:6]
+	and	r1, r1, #7
+	add	r1, r1, #9			@ cache size is at least 512 bytes (2^9)
+	mov	r2, r3, lsl r1
+	str	r2, [ip], #4
+	/* DLEN */
+	mov	r1, r0, lsr #12
+	and	r1, r1, #3			@ bits [13:12]
+	add	r1, r1, #3			@ cache line size is at least 8 bytes (2^3)
+	mov	r2, r3, lsl r1			@ r2 = 1<<r1
+	str	r2, [ip], #4
+	/* DSIZE */
+	mov	r1, r0, lsr #18			@ bits [20:18]
+	and	r1, r1, #7
+	add	r1, r1, #9			@ cache size is at least 512 bytes (2^9)
+	mov	r2, r3, lsl r1
+	str	r2, [ip]
+	mov	pc, lr
+
+	/* Warning : Do not change the order ! Successive codes depends on this */
+	.align
+	.globl __fa_cache_ilen, __fa_cache_isize, __fa_cache_dlen, __fa_cache_dsize
+__fa_cache_ilen:
+	.word	0				@ instruction cache line length
+__fa_cache_isize:
+	.word	0				@ instruction cache size
+__fa_cache_dlen:
+	.word	0				@ data cahce line length	
+__fa_cache_dsize:
+	.word	0				@ data cache size
+
+/* Luke Lee 04/06/2005 ins end */
+
+/*
+ *	flush_user_cache_all()
+ *
+ *	Clean and invalidate all cache entries in a particular address
+ *	space.
+ */
+ENTRY(fa_flush_user_cache_all)
+	/* FALLTHROUGH */
+/*
+ *	flush_kern_cache_all()
+ *
+ *	Clean and invalidate the entire cache.
+ */
+ENTRY(fa_flush_kern_cache_all)
+/* Luke Lee 04/06/2005 mod ok */
+	mov	ip, #0
+	
+#ifndef CONFIG_CPU_ICACHE_DISABLE
+	mcr	p15, 0, ip, c7, c5, 0		@ invalidate I cache
+#endif
+	
+__flush_whole_cache:
+	
+#ifndef CONFIG_CPU_DCACHE_DISABLE
+	mov	ip, #0
+#  ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
+	mcr	p15, 0, ip, c7, c6, 0		@ invalidate D cache
+#  else
+	mcr	p15, 0, ip, c7,c14, 0		@ clean/invalidate D cache
+#  endif
+#endif /*CONFIG_CPU_DCACHE_DISABLE*/
+	
+#ifndef CONFIG_CPU_FA_WB_DISABLE	
+	mcr	p15, 0, ip, c7, c10, 4		@ drain write buffer
+#endif
+	
+#ifdef CONFIG_CPU_FA_BTB
+	mcr	p15, 0, ip, c7, c5, 6		@ invalidate BTB
+	nop
+	nop
+#endif
+	
+/* Luke Lee 04/06/2005 que todo tofix : should iscratchpad and dscratchpad be invalidated ? */
+	mov	pc, lr
+
+/*
+ *	flush_user_cache_range(start, end, flags)
+ *
+ *	Invalidate a range of cache entries in the specified
+ *	address space.
+ *
+ *	- start - start address (inclusive, page aligned)
+ *	- end	- end address (exclusive, page aligned)
+ *	- flags	- vma_area_struct flags describing address space
+ */
+ENTRY(fa_flush_user_cache_range)
+
+/* Luke Lee 04/06/2005 mod ok */
+	/* Luke Lee 04/07/2005 ins 1 */
+	mov	ip, #0
+	sub	r3, r1, r0			@ calculate total size
+#ifndef CONFIG_CPU_ICACHE_DISABLE
+	tst	r2, #VM_EXEC			@ executable region?
+	mcrne	p15, 0, ip, c7, c5, 0		@ invalidate I cache
+#endif
+
+#ifndef CONFIG_CPU_DCACHE_DISABLE	
+	/* Luke Lee 04/06/2005 ins 2 mod 1 */
+	cmp	r3, #CACHE_DSIZE		@ total size >= limit?
+	bhs	__flush_whole_cache		@ flush whole D cache
+
+	//debug_Aaron
+        bic     r0, r0, #CACHE_DLINESIZE-1  
+	mcr	p15, 0, r0, c7, c14, 1		@ clean and invalidate boundary D entry
+        bic     r1, r1, #CACHE_DLINESIZE-1  
+	mcr	p15, 0, r1, c7, c14, 1		@ clean and invalidate boundary D entry
+
+
+1:	/* Luke Lee 04/06/2005 del 2 ins 5 */
+	
+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
+	mcr	p15, 0, r0, c7, c6, 1		@ invalidate D entry
+#else
+	mcr	p15, 0, r0, c7, c14, 1		@ clean and invalidate D entry
+#endif
+	/* Luke Lee 04/06/2005 mod 1 */
+	add	r0, r0, #CACHE_DLINESIZE
+	cmp	r0, r1
+	bls	1b				@ Luke Lee 05/19/2005
+#endif	/* CONFIG_CPU_DCACHE_DISABLE */
+	
+#ifndef CONFIG_CPU_FA_WB_DISABLE
+	tst	r2, #VM_EXEC
+	/* Luke Lee 04/06/2005 mod 1 tofix todo : ne->eq */
+	mcreq	p15, 0, r4, c7, c10, 4		@ drain write buffer
+#endif
+
+	/* Luke Lee 04/06/2005 ins block */
+#ifdef CONFIG_CPU_FA_BTB
+        tst     r2, #VM_EXEC
+	mov	ip, #0
+	mcrne	p15, 0, ip, c7, c5, 6		@ invalidate BTB
+	nop
+	nop
+#endif
+	mov	pc, lr
+
+/*
+ *	flush_kern_dcache_page(void *page)
+ *
+ *	Ensure no D cache aliasing occurs, either with itself or
+ *	the I cache
+ *
+ *	- addr	- page aligned address
+ */
+ENTRY(fa_flush_kern_dcache_page)
+	add	r1, r0, #PAGE_SZ
+	/* fall through */
+
+/*
+ *	coherent_kern_range(start, end)
+ *
+ *	Ensure coherency between the Icache and the Dcache in the
+ *	region described by start.  If you have non-snooping
+ *	Harvard caches, you need to implement this function.
+ *
+ *	- start  - virtual start address
+ *	- end	 - virtual end address
+ */
+ENTRY(fa_coherent_kern_range)
+	/* fall through */
+
+/*
+ *	coherent_user_range(start, end)
+ *
+ *	Ensure coherency between the Icache and the Dcache in the
+ *	region described by start.  If you have non-snooping
+ *	Harvard caches, you need to implement this function.
+ *
+ *	- start  - virtual start address
+ *	- end	 - virtual end address
+ */
+ENTRY(fa_coherent_user_range)
+
+/* Luke Lee 04/06/2005 mod ok */
+	/* Luke Lee 04/06/2005 ins 3 mod 1 */
+	bic	r0, r0, #CACHE_DLINESIZE-1
+
+ //debug_Aaron
+        bic     r0, r0, #CACHE_DLINESIZE-1
+        mcr     p15, 0, r0, c7, c14, 1          @ clean and invalidate boundary D entry
+        bic     r1, r1, #CACHE_DLINESIZE-1
+        mcr     p15, 0, r1, c7, c14, 1          @ clean and invalidate boundary D entry
+
+#if !(defined(CONFIG_CPU_DCACHE_DISABLE) && defined(CONFIG_CPU_ICACHE_DISABLE))
+1:	/* Luke Lee 04/06/2005 del 2 ins 5 mod 1 */
+#ifndef CONFIG_CPU_DCACHE_DISABLE	
+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
+	mcr	p15, 0, r0, c7, c6, 1		@ invalidate D entry
+#else
+	mcr	p15, 0, r0, c7, c14, 1		@ clean and invalidate D entry
+#endif
+#endif /* CONFIG_CPU_DCACHE_DISABLE */
+	
+#ifndef CONFIG_CPU_ICACHE_DISABLE
+	mcr	p15, 0, r0, c7, c5, 1		@ invalidate I entry
+#endif
+	add	r0, r0, #CACHE_DLINESIZE
+	cmp	r0, r1
+	bls	1b				@ Luke Lee 05/19/2005 blo->bls	
+#endif /* !(defined(CONFIG_CPU_DCACHE_DISABLE) && defined(CONFIG_CPU_ICACHE_DISABLE)) */
+
+	mov	ip, #0
+#ifdef CONFIG_CPU_FA_BTB
+	mcr	p15, 0, ip, c7, c5, 6		@ invalidate BTB
+	nop
+	nop
+#endif
+
+/* Luke Lee 04/08/2005 ins 1 skp 1 ins 1 */
+#ifndef CONFIG_CPU_FA_WB_DISABLE
+	mcr	p15, 0, ip, c7, c10, 4		@ drain WB
+#endif
+
+	mov	pc, lr
+
+/*
+ *	dma_inv_range(start, end)
+ *
+ *	Invalidate (discard) the specified virtual address range.
+ *	May not write back any entries.  If 'start' or 'end'
+ *	are not cache line aligned, those lines must be written
+ *	back.
+ *
+ *	- start  - virtual start address
+ *	- end	 - virtual end address
+ */
+ENTRY(fa_dma_inv_range)
+
+/* Luke Lee 04/06/2005 mod ok */
+
+#ifndef CONFIG_CPU_DCACHE_DISABLE	
+
+ //debug_Aaron
+        bic     r0, r0, #CACHE_DLINESIZE-1
+        mcr     p15, 0, r0, c7, c6, 1          @ invalidate boundary D entry
+        bic     r1, r1, #CACHE_DLINESIZE-1
+        mcr     p15, 0, r1, c7, c6, 1          @ invalidate boundary D entry
+
+	/* Luke Lee 04/06/2005 ins 4 mod 2 */
+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
+	tst	r0, #CACHE_DLINESIZE -1
+	bic	r0, r0, #CACHE_DLINESIZE -1
+
+//debug_Aaron
+	//mcrne	p15, 0, r0, c7, c10, 1		@ clean boundary D entry
+
+	/* Luke Lee 04/06/2005 mod 1 */
+	/* Luke Lee 05/19/2005 always clean the end-point boundary mcrne->mcr */
+	////tst	r1, #CACHE_DLINESIZE -1
+	//mcr	p15, 0, r1, c7, c10, 1		@ clean boundary D entry
+	/* Luke Lee 04/06/2005 ins 1 */
+#else
+	bic	r0, r0, #CACHE_DLINESIZE -1	
+#endif
+
+//debug_Aaron	
+1:	mcr	p15, 0, r0, c7, c6, 1		@ invalidate D entry
+//1:	mcr	p15, 0, r0, c7, c14, 1		@ clean and invalidate D entry
+
+	/* Luke Lee 04/06/2005 mod 1 */	
+	add	r0, r0, #CACHE_DLINESIZE
+	cmp	r0, r1
+	bls	1b				@ Luke Lee 05/19/2005 blo->bls
+#endif /* CONFIG_CPU_DCACHE_DISABLE */
+
+	/* Luke Lee 04/06/2005 ins 1 */		
+#ifndef CONFIG_CPU_FA_WB_DISABLE
+	mov	r0, #0
+	mcr	p15, 0, r0, c7, c10, 4		@ drain write buffer
+#endif	
+
+	mov	pc, lr
+
+/*
+ *	dma_clean_range(start, end)
+ *
+ *	Clean (write back) the specified virtual address range.
+ *
+ *	- start  - virtual start address
+ *	- end	 - virtual end address
+ */
+ENTRY(fa_dma_clean_range)
+
+/* Luke Lee 04/06/2005 mod ok */
+#ifndef CONFIG_CPU_DCACHE_DISABLE	
+
+ //debug_Aaron
+        bic     r0, r0, #CACHE_DLINESIZE-1
+        mcr     p15, 0, r0, c7, c10, 1          @ clean boundary D entry
+        bic     r1, r1, #CACHE_DLINESIZE-1
+        mcr     p15, 0, r1, c7, c10, 1          @ clean boundary D entry
+
+	/* Luke Lee 04/06/2005 ins 4 mod 2 */
+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
+	bic	r0, r0, #CACHE_DLINESIZE - 1
+
+//debug_Aaron
+1:	mcr	p15, 0, r0, c7, c10, 1		@ clean D entry
+//1:	mcr	p15, 0, r0, c7, c14, 1		@ clean D entry
+	add	r0, r0, #CACHE_DLINESIZE
+	cmp	r0, r1
+	bls	1b				@ Luke Lee 05/19/2005 blo->bls
+	/* Luke Lee 04/06/2005 ins 2 */
+#endif
+#endif /* CONFIG_CPU_DCACHE_DISABLE */
+
+#ifndef CONFIG_CPU_FA_WB_DISABLE
+	mov	r0, #0	
+	mcr	p15, 0, r0, c7, c10, 4		@ drain write buffer
+#endif	
+
+	mov	pc, lr
+
+/*
+ *	dma_flush_range(start, end)
+ *
+ *	Clean and invalidate the specified virtual address range.
+ *
+ *	- start  - virtual start address
+ *	- end	 - virtual end address
+ *
+ *	This is actually the same as fa_coherent_kern_range()
+ */
+	.globl	fa_dma_flush_range
+	.set	fa_dma_flush_range, fa_coherent_kern_range
+
+	__INITDATA
+
+	.type	fa_cache_fns, #object
+ENTRY(fa_cache_fns)
+	.long	fa_flush_kern_cache_all
+	.long	fa_flush_user_cache_all
+	.long	fa_flush_user_cache_range
+	.long	fa_coherent_kern_range
+	.long	fa_coherent_user_range
+	.long	fa_flush_kern_dcache_page
+	.long	fa_dma_inv_range
+	.long	fa_dma_clean_range
+	.long	fa_dma_flush_range
+	.size	fa_cache_fns, . - fa_cache_fns
--- /dev/null
+++ b/arch/arm/mm/copypage-fa.S
@@ -0,0 +1,106 @@
+/*
+ *  linux/arch/arm/lib/copypage-fa.S
+ *
+ *  Copyright (C) 2005 Faraday Corp.
+ *
+ * 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.
+ *
+ *  ASM optimised string functions
+ * 05/18/2005 :	Luke Lee created, modified from copypage-v4wb.S
+ */
+#include <linux/linkage.h>
+#include <linux/init.h>
+#include <asm/asm-offsets.h>
+
+	.text
+/*
+ * ARMv4 optimised copy_user_page for Faraday processors
+ *
+ * We flush the destination cache lines just before we write the data into the
+ * corresponding address.  Since the Dcache is read-allocate, this removes the
+ * Dcache aliasing issue.  The writes will be forwarded to the write buffer,
+ * and merged as appropriate.
+ *
+ * Note: We rely on all ARMv4 processors implementing the "invalidate D line"
+ * instruction.  If your processor does not supply this, you have to write your
+ * own copy_user_page that does the right thing.
+ *
+ * copy_user_page(to,from,vaddr)
+ */
+	.align	4
+ENTRY(fa_copy_user_page)
+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
+	/* Write through */
+	stmfd	sp!, {r4, lr}			@ 2
+	mov	r2, #PAGE_SZ/32			@ 1
+
+	ldmia	r1!, {r3, r4, ip, lr}		@ 4
+1:	stmia	r0!, {r3, r4, ip, lr}		@ 4
+	ldmia	r1!, {r3, r4, ip, lr}		@ 4+1
+	subs	r2, r2, #1			@ 1
+	stmia	r0!, {r3, r4, ip, lr}		@ 4
+	ldmneia	r1!, {r3, r4, ip, lr}		@ 4
+	bne	1b				@ 1
+
+	mcr	p15, 0, r2, c7, c7, 0		@ flush ID cache
+	ldmfd	sp!, {r4, pc}			@ 3
+#else
+	/* Write back */
+	stmfd	sp!, {r4, lr}			@ 2
+	mov	r2, #PAGE_SZ/32			@ 1
+
+1:	ldmia	r1!, {r3, r4, ip, lr}		@ 4
+	mcr	p15, 0, r0, c7, c6, 1		@ 1   invalidate D line
+	stmia	r0!, {r3, r4, ip, lr}		@ 4
+	ldmia	r1!, {r3, r4, ip, lr}		@ 4
+	mcr	p15, 0, r0, c7, c6, 1		@ 1   invalidate D line
+	stmia	r0!, {r3, r4, ip, lr}		@ 4
+	subs	r2, r2, #1			@ 1
+	bne	1b
+	mcr	p15, 0, r2, c7, c10, 4		@ 1   drain WB
+	ldmfd	sp!, {r4, pc}			@ 3
+#endif
+
+/*
+ * ARMv4 optimised clear_user_page
+ *
+ * Same story as above.
+ */
+	.align	4
+ENTRY(fa_clear_user_page)
+	str	lr, [sp, #-4]!
+	mov	r1, #PAGE_SZ/32			@ 1
+	mov	r2, #0				@ 1
+	mov	r3, #0				@ 1
+	mov	ip, #0				@ 1
+	mov	lr, #0				@ 1
+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
+	/* Write through */
+1:	stmia	r0!, {r2, r3, ip, lr}		@ 4
+	stmia	r0!, {r2, r3, ip, lr}		@ 4
+	subs	r1, r1, #1			@ 1
+	bne	1b				@ 1
+
+	mcr	p15, 0, r1, c7, c7, 0		@ flush ID cache
+	ldr	pc, [sp], #4
+#else
+	/* Write back */
+1:	mcr	p15, 0, r0, c7, c6, 1		@ 1   invalidate D line
+	stmia	r0!, {r2, r3, ip, lr}		@ 4
+	mcr	p15, 0, r0, c7, c6, 1		@ 1   invalidate D line
+	stmia	r0!, {r2, r3, ip, lr}		@ 4
+	subs	r1, r1, #1			@ 1
+	bne	1b				@ 1
+	mcr	p15, 0, r1, c7, c10, 4		@ 1   drain WB
+	ldr	pc, [sp], #4
+#endif
+
+	__INITDATA
+
+	.type	fa_user_fns, #object
+ENTRY(fa_user_fns)
+	.long	fa_clear_user_page
+	.long	fa_copy_user_page
+	.size	fa_user_fns, . - fa_user_fns
--- a/arch/arm/mm/init.c
+++ b/arch/arm/mm/init.c
@@ -23,6 +23,7 @@
 
 #include <asm/mach/arch.h>
 #include <asm/mach/map.h>
+#include <asm/arch/ipi.h>
 
 #include "mm.h"
 
@@ -252,6 +253,11 @@ bootmem_init_node(int node, int initrd_n
 		initrd_end = initrd_start + phys_initrd_size;
 	}
 #endif
+#ifdef CONFIG_GEMINI_IPI
+	printk("CPU ID:%d\n",getcpuid());
+//	reserve_bootmem_node(NODE_DATA(0), 0x400000, 0x400000);		//CPU0 space
+//	reserve_bootmem_node(NODE_DATA(0), SHAREADDR, SHARE_MEM_SIZE);		//share memory
+#endif
 
 	/*
 	 * Finally, reserve any node zero regions.
--- /dev/null
+++ b/arch/arm/mm/proc-fa526.S
@@ -0,0 +1,407 @@
+/*
+ *  linux/arch/arm/mm/proc-fa526.S: MMU functions for FA526
+ *
+ *  Copyright (C) 2005 Faraday Corp.
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ *
+ *
+ * These are the low level assembler for performing cache and TLB
+ * functions on the fa526.
+ *
+ *  Written by : Luke Lee
+ */
+#include <linux/linkage.h>
+#include <linux/init.h>
+#include <asm/assembler.h>
+#include <asm/pgtable.h>
+#include <asm/pgtable-hwdef.h>
+#include <asm/elf.h>
+#include <asm/hardware.h>
+#include <asm/page.h>
+#include <asm/ptrace.h>
+#include <asm/system.h>
+#include "proc-macros.S"
+
+#define CACHE_DLINESIZE	   16
+
+	.text
+/*
+ * cpu_fa526_proc_init()
+ */
+ENTRY(cpu_fa526_proc_init)
+	/* MMU is already ON here, ICACHE, DCACHE conditionally disabled */
+
+        mov     r0, #1
+	nop
+	nop
+        mcr     p15, 0, r0, c1, c1, 0		@ turn-on ECR
+	nop
+	nop
+
+	mrc	p15, 0, r0, c1, c0, 0		@ read ctrl register
+
+#ifdef CONFIG_CPU_FA_BTB
+	orr	r0, r0, #CR_Z
+#else
+	bic	r0, r0, #CR_Z
+#endif
+#ifdef CONFIG_CPU_FA_WB_DISABLE
+	mov	r1, #0
+	mcr	p15, 0, r1, c7, c10, 4		@ drain write buffer
+	nop
+	nop
+	bic	r0, r0, #CR_W
+#else
+	orr	r0, r0, #CR_W
+#endif
+#ifdef CONFIG_CPU_DCACHE_DISABLE
+	bic	r0, r0, #CR_C
+#else
+	orr	r0, r0, #CR_C
+#endif
+#ifdef CONFIG_CPU_ICACHE_DISABLE
+	bic	r0, r0, #CR_I
+#else
+	orr	r0, r0, #CR_I
+#endif
+
+	nop
+	nop
+    	mcr	p15, 0, r0, c1, c0, 0
+	nop
+	nop
+
+	mov	r5, lr
+	bl	fa_initialize_cache_info	@ destroy r0~r4
+	mov	pc, r5				@ return
+
+
+/*
+ * cpu_fa526_proc_fin()
+ */
+ENTRY(cpu_fa526_proc_fin)
+	stmfd	sp!, {lr}
+	mov	ip, #PSR_F_BIT | PSR_I_BIT | SVC_MODE
+	msr	cpsr_c, ip
+
+	bl	fa_flush_kern_cache_all
+	mrc	p15, 0, r0, c1, c0, 0		@ ctrl register
+	bic	r0, r0, #0x1000			@ ...i............
+	bic	r0, r0, #0x000e			@ ............wca.
+	mcr	p15, 0, r0, c1, c0, 0		@ disable caches
+
+	nop
+	nop
+	ldmfd	sp!, {pc}
+
+/*
+ * cpu_fa526_reset(loc)
+ *
+ * Perform a soft reset of the system.  Put the CPU into the
+ * same state as it would be if it had been reset, and branch
+ * to what would be the reset vector.
+ *
+ * loc: location to jump to for soft reset
+ */
+	.align	4
+ENTRY(cpu_fa526_reset)
+	mov	ip, #0
+	mcr	p15, 0, ip, c7, c7, 0		@ invalidate I,D caches
+#ifndef CONFIG_CPU_FA_WB_DISABLE
+	mcr	p15, 0, ip, c7, c10, 4		@ drain WB
+#endif
+	mcr	p15, 0, ip, c8, c7, 0		@ invalidate I & D TLBs
+	mrc	p15, 0, ip, c1, c0, 0		@ ctrl register
+	bic	ip, ip, #0x000f			@ ............wcam
+	bic	ip, ip, #0x1100			@ ...i...s........
+
+	bic	ip, ip, #0x0800			@ BTB off
+	mcr	p15, 0, ip, c1, c0, 0		@ ctrl register
+	nop
+	nop
+	mov	pc, r0
+
+/*
+ * cpu_fa526_do_idle()
+ */
+	.align	4
+ENTRY(cpu_fa526_do_idle)
+
+#ifdef CONFIG_CPU_FA_IDLE
+	nop
+	nop
+	mcr	p15, 0, r0, c7, c0, 4		@ Wait for interrupt (IDLE mode)
+#endif
+	mov	pc, lr
+
+
+ENTRY(cpu_fa526_dcache_clean_area)
+
+#ifndef CONFIG_CPU_DCACHE_DISABLE
+#ifndef CONFIG_CPU_DCACHE_WRITETHROUGH
+1:	mcr	p15, 0, r0, c7, c10, 1		@ clean D entry
+	add	r0, r0, #CACHE_DLINESIZE
+	subs	r1, r1, #CACHE_DLINESIZE
+	bhi	1b
+#endif
+#endif
+	mov	pc, lr
+
+
+/* =============================== PageTable ============================== */
+
+/*
+ * cpu_fa526_switch_mm(pgd)
+ *
+ * Set the translation base pointer to be as described by pgd.
+ *
+ * pgd: new page tables
+ */
+	.align	4
+
+	.globl	fault_address
+fault_address:
+	.long	0
+
+ENTRY(cpu_fa526_switch_mm)
+
+	mov	ip, #0
+#ifndef CONFIG_CPU_DCACHE_DISABLE
+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
+	mcr	p15, 0, ip, c7, c6, 0		@ invalidate D cache
+#else
+	mcr	p15, 0, ip, c7, c14, 0		@ Clean and invalidate whole DCache
+#endif
+#endif /*CONFIG_CPU_DCACHE_DISABLE*/
+
+#ifndef CONFIG_CPU_ICACHE_DISABLE
+	mcr	p15, 0, ip, c7, c5, 0		@ invalidate I cache
+#endif
+
+#ifndef CONFIG_CPU_FA_WB_DISABLE
+	mcr	p15, 0, ip, c7, c10, 4		@ drain WB
+#endif
+
+#ifdef CONFIG_CPU_FA_BTB
+	mcr	p15, 0, ip, c7, c5, 6		@ invalidate BTB since mm changed
+	nop
+	nop
+#endif
+	bic	r0, r0, #0xff			@ clear bits [7:0]
+	bic	r0, r0, #0x3f00			@ clear bits [13:8]
+	mcr	p15, 0, r0, c2, c0, 0		@ load page table pointer
+	mcr	p15, 0, ip, c8, c7, 0		@ invalidate UTLB
+	nop
+	nop
+	mov	pc, lr
+
+/*
+ * cpu_fa526_set_pte_ext(ptep, pte, ext)
+ *
+ * Set a PTE and flush it out
+ */
+	.align	4
+ENTRY(cpu_fa526_set_pte_ext)
+	str	r1, [r0], #-2048		@ linux version
+
+	eor	r1, r1, #L_PTE_PRESENT | L_PTE_YOUNG | L_PTE_WRITE | L_PTE_DIRTY
+
+	bic	r2, r1, #PTE_SMALL_AP_MASK
+	bic	r2, r2, #PTE_TYPE_MASK
+	orr	r2, r2, #PTE_TYPE_SMALL
+
+	tst	r1, #L_PTE_USER			@ User?
+	orrne	r2, r2, #PTE_SMALL_AP_URO_SRW
+
+	tst	r1, #L_PTE_WRITE | L_PTE_DIRTY	@ Write and Dirty?
+	orreq	r2, r2, #PTE_SMALL_AP_UNO_SRW
+
+	tst	r1, #L_PTE_PRESENT | L_PTE_YOUNG	@ Present and Young?
+	movne	r2, #0
+
+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
+	eor	r3, r2, #0x0a			@ C & small page?  1010
+	tst	r3, #0x0b			@		   1011
+	biceq	r2, r2, #4
+#endif
+	str	r2, [r0]			@ hardware version
+
+	mov	r2, #0
+	mcr	p15, 0, r2, c7, c10, 0		@ clean D cache	all
+
+#ifndef CONFIG_CPU_FA_WB_DISABLE
+	mcr	p15, 0, r2, c7, c10, 4		@ drain WB
+#endif
+#ifdef CONFIG_CPU_FA_BTB
+	mcr	p15, 0, r2, c7, c5, 6		@ invalidate BTB
+	nop
+	nop
+#endif
+	mov	pc, lr
+
+	__INIT
+
+	.type	__fa526_setup, #function
+__fa526_setup:
+	/* On return of this routine, r0 must carry correct flags for CFG register */
+	mov	r0, #0
+	mcr	p15, 0, r0, c7, c7		@ invalidate I,D caches on v4
+	mcr	p15, 0, r0, c7, c10, 4		@ drain write buffer on v4
+	mcr	p15, 0, r0, c8, c7		@ invalidate I,D TLBs on v4
+
+	mcr	p15, 0, r0, c7, c5, 5		@ invalidate IScratchpad RAM
+
+        mov     r0, #1
+        mcr     p15, 0, r0, c1, c1, 0		@ turn-on ECR
+
+	mrc	p15, 0, r0, c9, c1, 0		@ DScratchpad
+	bic	r0, r0, #1
+	mcr	p15, 0, r0, c9, c1, 0
+	mrc	p15, 0, r0, c9, c1, 1		@ IScratchpad
+	bic	r0, r0, #1
+	mcr	p15, 0, r0, c9, c1, 1
+
+	mov	r0, #0
+	mcr	p15, 0, r0, c1, c1, 0		@ turn-off ECR
+
+#ifdef CONFIG_CPU_FA_BTB
+	mcr	p15, 0, r0, c7, c5, 6		@ invalidate BTB All
+	nop
+	nop
+#endif
+
+	mov	r0, #0x1f			@ Domains 0, 1 = manager, 2 = client
+	mcr	p15, 0, r0, c3, c0		@ load domain access register
+
+	mrc	p15, 0, r0, c1, c0		@ get control register v4
+	ldr	r5, fa526_cr1_clear
+	bic	r0, r0, r5
+	ldr	r5, fa526_cr1_set
+	orr	r0, r0, r5
+
+#ifdef CONFIG_CPU_FA_BTB
+	orr	r0, r0, #CR_Z
+#else
+	bic	r0, r0, #CR_Z
+#endif
+#ifdef CONFIG_CPU_FA_WB_DISABLE
+	mov	r12, #0
+	mcr	p15, 0, r12, c7, c10, 4		@ drain write buffer
+	nop
+	nop
+	bic	r0, r0, #CR_W			@ .... .... .... 1...
+#else
+	orr	r0, r0, #CR_W
+#endif
+
+	mov	pc, lr
+	.size	__fa526_setup, . - __fa526_setup
+
+	/*
+	 * .RVI ZFRS BLDP WCAM
+	 * ..11 0001 .111 1101
+	 *
+	 */
+	.type	fa526_cr1_clear, #object
+	.type	fa526_cr1_set, #object
+fa526_cr1_clear:
+	.word	0x3f3f
+fa526_cr1_set:
+	.word	0x317D
+
+	__INITDATA
+
+/*
+ * Purpose : Function pointers used to access above functions - all calls
+ *	     come through these
+ */
+	.type	fa526_processor_functions, #object
+fa526_processor_functions:
+	.word	v4_early_abort
+	.word	cpu_fa526_proc_init
+	.word	cpu_fa526_proc_fin
+	.word	cpu_fa526_reset
+	.word   cpu_fa526_do_idle
+	.word	cpu_fa526_dcache_clean_area
+	.word	cpu_fa526_switch_mm
+	.word	cpu_fa526_set_pte_ext
+	.size	fa526_processor_functions, . - fa526_processor_functions
+
+	.section ".rodata"
+
+	.type	cpu_arch_name, #object
+cpu_arch_name:
+	.asciz	"armv4"
+	.size	cpu_arch_name, . - cpu_arch_name
+
+	.type	cpu_elf_name, #object
+cpu_elf_name:
+	.asciz	"v4"
+	.size	cpu_elf_name, . - cpu_elf_name
+
+	.type	cpu_fa526_name, #object
+cpu_fa526_name:
+	.ascii	"FA526"
+#ifndef CONFIG_CPU_ICACHE_DISABLE
+	.ascii	"i"
+#endif
+#ifndef CONFIG_CPU_DCACHE_DISABLE
+	.ascii	"d"
+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
+	.ascii	"(wt)"
+#else
+	.ascii	"(wb)"
+#endif
+#endif
+	.ascii	"\0"
+	.size	cpu_fa526_name, . - cpu_fa526_name
+
+	.align
+
+	.section ".proc.info.init", #alloc, #execinstr
+
+#ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
+#define __PMD_SECT_BUFFERABLE	0
+#else
+#define __PMD_SECT_BUFFERABLE	PMD_SECT_BUFFERABLE
+#endif
+
+	.type	__fa526_proc_info,#object
+__fa526_proc_info:
+	.long	0x66015261
+	.long	0xff01fff1
+	.long   PMD_TYPE_SECT | \
+		__PMD_SECT_BUFFERABLE | \
+		PMD_SECT_CACHEABLE | \
+		PMD_BIT4 | \
+		PMD_SECT_AP_WRITE | \
+		PMD_SECT_AP_READ
+	.long   PMD_TYPE_SECT | \
+		PMD_BIT4 | \
+		PMD_SECT_AP_WRITE | \
+		PMD_SECT_AP_READ
+	b	__fa526_setup
+	.long	cpu_arch_name
+	.long	cpu_elf_name
+	.long	HWCAP_SWP | HWCAP_HALF
+	.long	cpu_fa526_name
+	.long	fa526_processor_functions
+	.long	fa_tlb_fns
+	.long	fa_user_fns
+	.long	fa_cache_fns
+	.size	__fa526_proc_info, . - __fa526_proc_info
+
+
--- /dev/null
+++ b/arch/arm/mm/tlb-fa.S
@@ -0,0 +1,96 @@
+/*
+ *  linux/arch/arm/mm/tlb-fa.S
+ *
+ *  Copyright (C) 2005 Faraday Corp.
+ *
+ * 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.
+ *
+ *  ARM architecture version 4, Faraday variation.
+ *  This assume an unified TLBs, with a write buffer, and branch target buffer (BTB)
+ *
+ *  Processors: FA520 FA526 FA626
+ *  03/31/2005 : Created by Luke Lee, modified from tlb-v4wbi.S
+ *  05/06/2005 : Fixed buggy CPU versions that did not invalidate the associated
+ *               data cache entries when invalidating TLB entries.
+ */
+#include <linux/linkage.h>
+#include <linux/init.h>
+#include <asm/asm-offsets.h>
+#include <asm/tlbflush.h>
+#include "proc-macros.S"
+
+
+/*
+ *	flush_user_tlb_range(start, end, mm)
+ *
+ *	Invalidate a range of TLB entries in the specified address space.
+ *
+ *	- start - range start address
+ *	- end   - range end address
+ *	- mm    - mm_struct describing address space
+ */
+	.align	4
+ENTRY(fa_flush_user_tlb_range)
+
+	vma_vm_mm ip, r2
+	act_mm	r3				@ get current->active_mm
+	eors	r3, ip, r3			@ == mm ?
+	movne	pc, lr				@ no, we dont do anything
+	mov	r3, #0
+
+#ifndef CONFIG_CPU_FA_WB_DISABLE
+	mcr	p15, 0, r3, c7, c10, 4		@ drain WB
+#endif
+
+	vma_vm_flags r2, r2
+	bic	r0, r0, #0x0ff
+	bic	r0, r0, #0xf00
+
+1:	mcr	p15, 0, r0, c8, c7, 1		@ invalidate UTLB entry
+	add	r0, r0, #PAGE_SZ
+	cmp	r0, r1
+	bls	1b				@ Luke Lee 05/19/2005 blo -> bls
+
+#ifdef CONFIG_CPU_FA_BTB
+	mcr	p15, 0, r3, c7, c5, 6		@ invalidate BTB
+	nop
+	nop
+#endif
+	mov	pc, lr
+
+
+ENTRY(fa_flush_kern_tlb_range)
+	mov	r3, #0
+
+	mcr	p15, 0, r3, c7, c10, 0		@ clean Dcache all 06/03/2005
+
+#ifndef CONFIG_CPU_FA_WB_DISABLE
+	mcr	p15, 0, r3, c7, c10, 4		@ drain WB
+#endif
+
+	bic	r0, r0, #0x0ff
+	bic	r0, r0, #0xf00
+1:
+	mcr	p15, 0, r0, c8, c7, 1		@ invalidate UTLB entry
+	add	r0, r0, #PAGE_SZ
+	cmp	r0, r1
+	bls	1b				@ Luke Lee 05/19/2005 blo -> bls
+
+#ifdef CONFIG_CPU_FA_BTB
+	mcr	p15, 0, r3, c7, c5, 6		@ invalidate BTB
+	nop
+	nop
+#endif
+	mov	pc, lr
+
+
+	__INITDATA
+
+	.type	fa_tlb_fns, #object
+ENTRY(fa_tlb_fns)
+	.long	fa_flush_user_tlb_range
+	.long	fa_flush_kern_tlb_range
+	.long	fa_tlb_flags
+	.size	fa_tlb_fns, . - fa_tlb_fns
--- a/arch/arm/tools/mach-types
+++ b/arch/arm/tools/mach-types
@@ -208,7 +208,8 @@ karo			ARCH_KARO		KARO			190
 fester			SA1100_FESTER		FESTER			191
 gpi			ARCH_GPI		GPI			192
 smdk2410		ARCH_SMDK2410		SMDK2410		193
-i519			ARCH_I519		I519			194
+#i519			ARCH_I519		I519			194
+sl2312          ARCH_SL2312         SL2312          194
 nexio			SA1100_NEXIO		NEXIO			195
 bitbox			SA1100_BITBOX		BITBOX			196
 g200			SA1100_G200		G200			197
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/SL_gpio.h
@@ -0,0 +1,59 @@
+#define GPIO_MINOR_LAST 31
+#define GPIO_MAJOR	120	// Experiemental
+
+#define GPIO_IRQ_NBR	12
+
+#define GPIOBASEADDR		(IO_ADDRESS(0x021000000))
+
+#define GPIODATAOUTOFF		0x00
+#define GPIODATAINOFF		0x04
+#define GPIOPINDIROFF		0x08
+#define GPIOPINBYPASSOFF	0x0C
+#define GPIODATASETOFF		0x10
+#define GPIODATACLEAROFF	0x14
+#define GPIOPINPULLENBOFF	0x18
+#define GPIOPINPULLTPOFF	0x1C
+#define GPIOINTRENBOFF		0x20
+#define GPIOINTRRAWSOFF		0x24
+#define GPIOINTRMASKEDSTATEOFF	0x28
+#define GPIOINTRMASKOFF		0x2C
+#define GPIOINTRCLEAROFF	0x30
+#define GPIOINTRTRIGGEROFF	0x34
+#define GPIOINTRBOTHOFF		0x38
+#define GPIOINTRRISENEGOFF	0x3C
+#define GPIOBNCEENBOFF		0x40
+#define GPIOBNCEPRESOFF		0x44
+
+#define GPIO_IOCTRL_SETDIR	0x20
+#define GPIO_IOCTRL_SET		0x40
+#define GPIO_IOCTRL_CLEAR	0x50
+#define GPIO_IOCTRL_ENBINT	0x60
+#define GPIO_IOCTRL_MASKINT	0x70
+#define GPIO_IOCTRL_LVLTRIG	0x75
+#define GPIO_IOCTRL_EDGINT	0x77
+#define GPIO_IOCTRL_EDGPOLINT	0x78
+#define GPIO_IOCTRL_BYPASS	0x30
+#define GPIO_IOCTRL_PRESCLK	0x80
+#define GPIO_IOCTRL_CLKVAL	0x90
+#define GPIO_IOCTRL_PULLENB	0xA0
+#define GPIO_IOCTRL_PULLTYPE	0xA8
+
+
+#define GPIO_MAJOR	120	/* experimental MAJOR number */
+				// Minor - 0 : 31 gpio pins
+
+#define GPIO_SET	0x01
+#define GPIO_CLEAR	0x01
+
+#define GPIO_INPUT	0
+#define GPIO_OUTPUT	1
+#define GPIO_EDGEINTR 	0
+#define GPIO_EDGESINGL	0
+#define GPIO_EDGEBOTH	1
+#define GPIO_POSITIVE	0
+#define GPIO_ENBINT	1
+#define GPIO_DISABLEMASK	1
+#define GPIO_PULLDOWN	0
+#define GPIO_PULLUP	1
+#define GPIO_ENABLEPULL	1
+#define GPIO_DISABLEPULL	0
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/debug-macro.S
@@ -0,0 +1,20 @@
+/* linux/include/asm-arm/arch-ebsa110/debug-macro.S
+ *
+ * Debugging macro include header
+ *
+ *  Copyright (C) 1994-1999 Russell King
+ *  Moved from linux/arch/arm/kernel/debug.S by Ben Dooks
+ *
+ * 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.
+ *
+**/
+
+		.macro	addruart,rx
+		mov	\rx, #0x42000000
+		.endm
+
+#define UART_SHIFT	2
+#define FLOW_CONTROL
+#include <asm/hardware/debug-8250.S>
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/dma.h
@@ -0,0 +1,28 @@
+/*
+ *  linux/include/asm-arm/arch-camelot/dma.h
+ *
+ *  Copyright (C) 1997,1998 Russell King
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#ifndef __ASM_ARCH_DMA_H
+#define __ASM_ARCH_DMA_H
+
+#define MAX_DMA_ADDRESS		0xffffffff
+
+#define MAX_DMA_CHANNELS	0
+
+#endif /* _ASM_ARCH_DMA_H */
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/entry-macro.S
@@ -0,0 +1,42 @@
+/*
+ * include/asm-arm/arch-arm/entry-macro.S
+ *
+ * Low-level IRQ helper macros for ebsa110 platform.
+ *
+ * This file is licensed under  the terms of the GNU General Public
+ * License version 2. This program is licensed "as is" without any
+ * warranty of any kind, whether express or implied.
+ */
+#include <asm/arch/platform.h>
+#include <asm/arch/int_ctrl.h>
+
+
+                .macro  disable_fiq
+                .endm
+
+                .macro  get_irqnr_preamble, base, tmp
+                .endm
+
+                .macro  arch_ret_to_user, tmp1, tmp2
+                .endm
+
+                .macro  get_irqnr_and_base, irqnr, irqstat, base, tmp
+                ldr     \irqstat, =IRQ_STATUS(IO_ADDRESS(SL2312_INTERRUPT_BASE))
+                ldr     \irqnr,[\irqstat]
+                cmp     \irqnr,#0
+                beq     2313f
+                mov     \tmp,\irqnr
+                mov     \irqnr,#0
+2312:
+                tst     \tmp, #1
+                bne     2313f
+                add     \irqnr, \irqnr, #1
+                mov     \tmp, \tmp, lsr #1
+                cmp     \irqnr, #31
+                bcc     2312b
+2313:
+                .endm
+
+                .macro  irq_prio_table
+                .endm
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/flash.h
@@ -0,0 +1,83 @@
+#ifndef __ASM_ARM_ARCH_FLASH_H
+#define __ASM_ARM_ARCH_FLASH_H
+
+#define FLASH_START                                     SL2312_FLASH_BASE
+#define SFLASH_SIZE                      		0x00400000
+#define SPAGE_SIZE                       		0x200
+#define BLOCK_ERASE                     		0x50
+#define BUFFER1_READ                    		0x54
+#define BUFFER2_READ                    		0x56
+#define PAGE_ERASE                      		0x81
+#define MAIN_MEMORY_PAGE_READ           		0x52
+#define MAIN_MEMORY_PROGRAM_BUFFER1     		0x82
+#define MAIN_MEMORY_PROGRAM_BUFFER2     		0x85
+#define BUFFER1_TO_MAIN_MEMORY          		0x83
+#define BUFFER2_TO_MAIN_MEMORY          		0x86
+#define MAIN_MEMORY_TO_BUFFER1          		0x53
+#define MAIN_MEMORY_TO_BUFFER2          		0x55
+#define BUFFER1_WRITE                   		0x84
+#define BUFFER2_WRITE                   		0x87
+#define AUTO_PAGE_REWRITE_BUFFER1       		0x58
+#define AUTO_PAGE_REWRITE_BUFFER2       		0x59
+#define READ_STATUS                     		0x57
+
+#define MAIN_MEMORY_PAGE_READ_SPI       		0xD2
+#define BUFFER1_READ_SPI                		0xD4
+#define BUFFER2_READ_SPI                		0xD6
+#define READ_STATUS_SPI                 		0xD7
+
+#define	FLASH_ACCESS_OFFSET	        		0x00000010
+#define	FLASH_ADDRESS_OFFSET            		0x00000014
+#define	FLASH_WRITE_DATA_OFFSET         		0x00000018
+#define	FLASH_READ_DATA_OFFSET          		0x00000018
+#define SERIAL_FLASH_CHIP1_EN            0x00010000  // 16th bit = 1
+#define SERIAL_FLASH_CHIP0_EN            0x00000000  // 16th bit = 0
+#define AT45DB321_PAGE_SHIFT		         0xa
+#define AT45DB642_PAGE_SHIFT		         0xb
+#define CONTINUOUS_MODE		         0x00008000
+
+#define FLASH_ACCESS_ACTION_OPCODE                      0x0000
+#define FLASH_ACCESS_ACTION_OPCODE_DATA                 0x0100
+#define FLASH_ACCESS_ACTION_SHIFT_ADDRESS               0x0200
+#define FLASH_ACCESS_ACTION_SHIFT_ADDRESS_DATA          0x0300
+#define FLASH_ACCESS_ACTION_SHIFT_ADDRESS_X_DATA          0x0400
+#define FLASH_ACCESS_ACTION_SHIFT_ADDRESS_2X_DATA         0x0500
+#define FLASH_ACCESS_ACTION_SHIFT_ADDRESS_3X_DATA         0x0600
+#define FLASH_ACCESS_ACTION_SHIFT_ADDRESS_4X_DATA         0x0700
+//#define FLASH_ACCESS_ACTION_SHIFT_ADDRESS_X_DATA        0x0600
+//#define FLASH_ACCESS_ACTION_SHIFT_ADDRESS_4X_DATA       0x0700
+
+#define M25P80_PAGE_SIZE  0x100
+#define M25P80_SECTOR_SIZE  0x10000
+
+
+//#define M25P80_BULK_ERASE                                      1
+//#define M25P80_SECTOR_ERASE                                    2
+//#define M25P80_SECTOR_SIZE                                     0x10000
+
+#define M25P80_WRITE_ENABLE                  		0x06
+#define M25P80_WRITE_DISABLE                 		0x04
+#define M25P80_READ_STATUS                   		0x05
+#define M25P80_WRITE_STATUS              		0x01
+#define M25P80_READ                      		0x03
+#define M25P80_FAST_READ                 		0x0B
+#define M25P80_PAGE_PROGRAM              		0x02
+#define M25P80_SECTOR_ERASE              		0xD8
+#define M25P80_BULK_ERASE                		0xC7
+#define FLASH_ERR_OK							0x0
+
+extern void address_to_page(__u32, __u16 *, __u16 *);
+extern void main_memory_page_read(__u8, __u16, __u16, __u8 *);
+extern void buffer_to_main_memory(__u8, __u16);
+extern void main_memory_to_buffer(__u8, __u16);
+extern void main_memory_page_program(__u8, __u16, __u16, __u8);
+extern void atmel_flash_read_page(__u32, __u8 *, __u32);
+extern void atmel_erase_page(__u8, __u16);
+extern void atmel_read_status(__u8, __u8 *);
+extern void atmel_flash_program_page(__u32, __u8 *, __u32);
+extern void atmel_buffer_write(__u8, __u16, __u8);
+extern void flash_delay(void);
+
+extern int m25p80_sector_erase(__u32 address, __u32 schip_en);
+
+#endif
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/gemini_cir.h
@@ -0,0 +1,102 @@
+#ifndef _ASM_ARCH_CIR_H
+#define _ASM_ARCH_CIR_H
+#include <linux/ioctl.h>
+
+#define VCR_KEY_POWER		0x613E609F
+#define TV1_KEY_POWER		0x40040100
+#define TV1_KEY_POWER_EXT	0xBCBD
+#define RC5_KER_POWER		0x0CF3
+
+#define VCC_H_ACT_PER		(16-1)
+#define VCC_L_ACT_PER		(8-1)
+#define VCC_DATA_LEN		(32-1)
+#define TV1_H_ACT_PER		(8-1)
+#define TV1_L_ACT_PER		(4-1)
+#define TV1_DATA_LEN		(48-1)
+
+#define VCC_BAUD		540
+#define TV1_BAUD		430
+#ifdef  CONFIG_SL3516_ASIC
+#define	EXT_CLK			60
+#else
+#define	EXT_CLK			20
+#endif
+
+#define	NEC_PROTOCOL	0x0
+#define	RC5_PROTOCOL	0x1
+#define VCC_PROTOCOL	0x0
+#define TV1_PROTOCOL	0x01
+
+#ifndef	SL2312_CIR_BASE
+#define	SL2312_CIR_BASE		0x4C000000
+#endif
+#define	CIR_BASE_ADDR		IO_ADDRESS(SL2312_CIR_BASE)
+#define STORLINK_CIR_ID		0x00010400
+
+#define	CIR_IP_ID		*(volatile unsigned int *)(CIR_BASE_ADDR + 0x00)
+#define	CIR_CTR_REG		*(volatile unsigned int *)(CIR_BASE_ADDR + 0x04)
+#define	CIR_STATUS_REG		*(volatile unsigned int *)(CIR_BASE_ADDR + 0x08)
+#define	CIR_RX_REG		*(volatile unsigned int *)(CIR_BASE_ADDR + 0x0C)
+#define	CIR_RX_EXT_REG		*(volatile unsigned int *)(CIR_BASE_ADDR + 0x10)
+#define	CIR_PWR_REG		*(volatile unsigned int *)(CIR_BASE_ADDR + 0x14)
+#define	CIR_PWR_EXT_REG		*(volatile unsigned int *)(CIR_BASE_ADDR + 0x18)
+#define	CIR_TX_CTR_REG		*(volatile unsigned int *)(CIR_BASE_ADDR + 0x1C)
+#define	CIR_TX_FEQ_REG		*(volatile unsigned int *)(CIR_BASE_ADDR + 0x20)
+#define	CIR_TX_REG		*(volatile unsigned int *)(CIR_BASE_ADDR + 0x24)
+#define	CIR_TX_EXT_REG		*(volatile unsigned int *)(CIR_BASE_ADDR + 0x28)
+
+
+#ifndef	SL2312_POWER_CTRL_BASE
+#define	SL2312_POWER_CTRL_BASE		0x4B000000
+#endif
+
+#ifndef PWR_BASE_ADDR
+#define	PWR_BASE_ADDR		IO_ADDRESS(SL2312_POWER_CTRL_BASE)
+#endif
+#define	PWR_CTRL_ID		*(unsigned int*)(PWR_BASE_ADDR+0x00)
+#define	PWR_CTRL_REG		*(unsigned int*)(PWR_BASE_ADDR+0x04)
+#define	PWR_STATUS_REG		*(unsigned int*)(PWR_BASE_ADDR+0x08)
+
+
+#define BIT(x)			(1<<x)
+#define TX_STATUS		BIT(3)
+
+#define	PWR_STAT_CIR		0x10
+#define	PWR_STAT_RTC		0x20
+#define	PWR_STAT_PUSH		0x40
+#define	PWR_SHUTDOWN		0x01
+
+#define CARR_FREQ		38000
+
+struct cir_ioctl_data {
+	__u32 data;
+};
+struct cir_ioctl_data48 {
+	__u32 timeout;
+	__u32 length;
+	__u8  ret;
+	__u32 data;
+	__u32 data_ext;
+};
+#define OLD_DATA			0
+#define NEW_RECEIVE			1
+
+#define	CIR_IOCTL_BASE		('I'|'R')
+#define CIR_SET_BAUDRATE			_IOW (CIR_IOCTL_BASE,  0, struct cir_ioctl_data)
+#define CIR_SET_HIGH_PERIOD			_IOW (CIR_IOCTL_BASE,  1, struct cir_ioctl_data)
+#define CIR_SET_LOW_PERIOD			_IOW (CIR_IOCTL_BASE,  2, struct cir_ioctl_data)
+#define CIR_SET_PROTOCOL			_IOW (CIR_IOCTL_BASE,  3, struct cir_ioctl_data)
+#define CIR_SET_ENABLE_COMPARE		_IOW (CIR_IOCTL_BASE,  4, struct cir_ioctl_data)
+#define CIR_SET_ENABLE_DEMOD		_IOW (CIR_IOCTL_BASE,  5, struct cir_ioctl_data)
+#define CIR_SET_POWER_KEY			_IOW (CIR_IOCTL_BASE,  6, struct cir_ioctl_data)
+#define CIR_GET_BAUDRATE			_IOR (CIR_IOCTL_BASE,  7, struct cir_ioctl_data)
+#define CIR_GET_HIGH_PERIOD			_IOR (CIR_IOCTL_BASE,  8 ,struct cir_ioctl_data)
+#define CIR_GET_LOW_PERIOD			_IOR (CIR_IOCTL_BASE,  9 ,struct cir_ioctl_data)
+#define CIR_GET_PROTOCOL			_IOR (CIR_IOCTL_BASE, 10, struct cir_ioctl_data)
+#define CIR_GET_ENABLE_COMPARE		_IOR (CIR_IOCTL_BASE, 11, struct cir_ioctl_data)
+#define CIR_GET_ENABLE_DEMOD		_IOR (CIR_IOCTL_BASE, 12, struct cir_ioctl_data)
+#define CIR_GET_POWER_KEY			_IOR (CIR_IOCTL_BASE, 13, struct cir_ioctl_data)
+#define CIR_GET_DATA				_IOWR (CIR_IOCTL_BASE, 14, struct cir_ioctl_data48)
+#define CIR_WAIT_INT_DATA			_IOWR (CIR_IOCTL_BASE, 15, struct cir_ioctl_data48)
+
+#endif //_ASM_ARCH_CIR_H
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/gemini_gpio.h
@@ -0,0 +1,77 @@
+/*
+ * FILE NAME gemini_gpio.h
+ *
+ * BRIEF MODULE DESCRIPTION
+ *	Generic Gemini GPIO
+ *
+ *  Author: Storlink Software [Device driver]
+ *          Jason Lee <jason@storlink.com.tw>
+ *
+ * Copyright 2005 Storlink Inc.
+ *
+ *  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.
+ *
+ *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
+ *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
+ *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
+ *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
+ *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
+ *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
+ *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
+ *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ *
+ *  You should have received a copy of the  GNU General Public License along
+ *  with this program; if not, write  to the Free Software Foundation, Inc.,
+ *  675 Mass Ave, Cambridge, MA 02139, USA.
+ */
+
+#ifndef __GEMINI_GPIO_H
+#define __GEMINI_GPIO_H
+
+#include <linux/ioctl.h>
+
+#define STATUS_HIGH	1
+#define STATUS_LOW	0
+#define DIRECT_OUT	1
+#define DIRECT_IN	0
+
+#define EDGE_TRIG	0
+#define RISING_EDGE	0
+#define FALL_EDGE	1
+#define SINGLE_EDGE	0
+#define BOTH_EDGE	1
+
+#define LEVEL_TRIG	1
+#define HIGH_ACTIVE	0
+#define LOW_ACTIVE	1
+
+struct gemini_gpio_ioctl_data {
+	__u32 pin;
+	__u8 status;			// status or pin direction
+					// 0: status low or Input
+					// 1: status high or Output
+
+	/* these member are used to config GPIO interrupt parameter */
+	__u8	use_default;		// if not sure ,set this argument 1
+	__u8	trig_type;		// 0/1:edge/level triger ?
+	__u8	trig_polar;		// 0/1:rising/falling high/low active ?
+	__u8	trig_both;		// 0/1:single/both detect both ?
+};
+
+#define GEMINI_GPIO_IOCTL_BASE	'Z'
+
+#define GEMINI_SET_GPIO_PIN_DIR		_IOW (GEMINI_GPIO_IOCTL_BASE,16, struct gemini_gpio_ioctl_data)
+#define	GEMINI_SET_GPIO_PIN_STATUS	_IOW (GEMINI_GPIO_IOCTL_BASE,17, struct gemini_gpio_ioctl_data)
+#define	GEMINI_GET_GPIO_PIN_STATUS	_IOWR(GEMINI_GPIO_IOCTL_BASE,18, struct gemini_gpio_ioctl_data)
+#define GEMINI_WAIT_GPIO_PIN_INT	_IOWR(GEMINI_GPIO_IOCTL_BASE,19, struct gemini_gpio_ioctl_data)
+
+
+extern void init_gpio_int(__u32 pin,__u8 trig_type,__u8 trig_polar,__u8 trig_both);
+extern int request_gpio_irq(int bit,void (*handler)(int),char level,char high,char both);
+extern int free_gpio_irq(int bit);
+#endif
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/gemini_i2s.h
@@ -0,0 +1,169 @@
+#ifndef __GEMINI_I2S_H__
+#define __GEMINI_I2S_H__
+#include <linux/ioctl.h>
+#include <linux/types.h>
+#include <asm/arch-sl2312/irqs.h>
+
+typedef __u16 UINT16;
+typedef __u32 UINT32;
+typedef __u8 UINT8;
+typedef __u8 BOOL;
+
+/***************************************/
+/* define GPIO module base address     */
+/***************************************/
+#define DMA_CONTROL_PHY_BASE  (IO_ADDRESS(SL2312_GENERAL_DMA_BASE))
+#define DMA_CONTROL_SSP_BASE  (IO_ADDRESS(SL2312_SSP_CTRL_BASE))
+#define SSP_INT				IRQ_SSP
+#define GPIO_BASE_ADDR      (IO_ADDRESS(SL2312_GPIO_BASE))
+#define GPIO_BASE_ADDR1      (IO_ADDRESS(SL2312_GPIO_BASE1))
+#define GLOBAL_BASE      (IO_ADDRESS(SL2312_GLOBAL_BASE))
+
+/* define read/write register utility */
+#define READ_SSP_REG(offset)			(__raw_readl(offset+DMA_CONTROL_SSP_BASE))
+#define WRITE_SSP_REG(offset,val) 	(__raw_writel(val,offset+DMA_CONTROL_SSP_BASE))
+
+#define READ_GPIO_REG(offset)			(__raw_readl(offset+GPIO_BASE_ADDR))
+#define WRITE_GPIO_REG(offset,val) 	(__raw_writel(val,offset+GPIO_BASE_ADDR))
+
+#define READ_GPIO1_REG(offset)			(__raw_readl(offset+GPIO_BASE_ADDR1))
+#define WRITE_GPIO1_REG(offset,val) 	(__raw_writel(val,offset+GPIO_BASE_ADDR1))
+
+#define READ_DMA_REG(offset)			(__raw_readl(offset+DMA_CONTROL_PHY_BASE))
+#define WRITE_DMA_REG(offset,val) 	(__raw_writel(val,offset+DMA_CONTROL_PHY_BASE))
+
+#define READ_GLOBAL_REG(offset)			(__raw_readl(offset+GLOBAL_BASE))
+#define WRITE_GLOBAL_REG(offset,val) 	(__raw_writel(val,offset+GLOBAL_BASE))
+
+#define SSP_GPIO_INT       	IRQ_GPIO
+
+#ifndef CONFIG_SL3516_ASIC
+#define SSP_GPIO_INT_BIT    0x00000400				//GPIO[10] : SLIC interrupt pin
+
+#define GPIO_EECK	     0x00000040         /*   SCK: GPIO[06]   */
+#define GPIO_EECS	     0x00000080			/*   SCS: GPIO[07]   */
+#define GPIO_MISO	     0x00000200         /*   SDO: GPIO[09]   receive from 6996*/
+#define GPIO_MOSI	     0x00000100         /*   SDI: GPIO[08]   send to 6996*/
+#define GPIO_MISO_BIT	 9
+#else
+#define SSP_GPIO_INT_BIT    0x00000001				//GPIO[0] : SLIC interrupt pin
+
+//#if 0
+//#define GPIO_EECK	     0x80000000         /*   SCK: GPIO1[31]   */
+//#define GPIO_EECS	     0x40000000			/*   SCS: GPIO1[30]   */
+//#define GPIO_MISO	     0x20000000         /*   SDO: GPIO1[29]   receive from 6996*/
+//#define GPIO_MOSI	     0x10000000         /*   SDI: GPIO1[28]   send to 6996*/
+//#define GPIO_MISO_BIT	29
+//#else
+//#define GPIO_EECK	     0x00000100         /*   SCK: GPIO1[08]   */
+//#define GPIO_EECS	     0x08000000			/*   SCS: GPIO1[27]   */
+//#define GPIO_MISO	     0x00000080         /*   SDO: GPIO1[07]   receive from 6996*/
+//#define GPIO_MOSI	     0x00000200         /*   SDI: GPIO1[09]   send to 6996*/
+//#define GPIO_MISO_BIT	7
+//#endif
+#endif
+
+
+enum GPIO_REG
+{
+	GPIO_DATA_OUT   	= 0x00,
+	GPIO_DATA_IN    	= 0x04,
+	GPIO_PIN_DIR    	= 0x08,
+	GPIO_BY_PASS    	= 0x0c,
+	GPIO_DATA_SET   	= 0x10,
+	GPIO_DATA_CLEAR 	= 0x14,
+	GPIO_INT_ENABLE     = 0x20,
+	GPIO_INT_RAWSTATE   = 0x24,
+	GPIO_INT_MASKSTATE  = 0x28,
+	GPIO_INT_MASK       = 0x2C,
+	GPIO_INT_CLEAR      = 0x30,
+	GPIO_INT_TRIGGER    = 0x34,
+	GPIO_INT_BOTH       = 0x38,
+	GPIO_INT_POLARITY   = 0x3C
+};
+
+typedef struct
+{
+	UINT32 src_addr;
+	UINT32 dst_addr;
+	UINT32 llp;
+	UINT32 ctrl_size;
+	UINT32 owner;
+}DMA_LLP_t;
+
+typedef struct
+{
+	UINT32 owner;
+	UINT32 src_addr;
+	UINT32 ctrl_size;
+}IOCTL_LLP_t;
+
+typedef unsigned char byte;
+typedef unsigned short word;
+typedef unsigned long dword;
+
+/* DMA Registers */
+#define	DMA_INT 		   		0x00000000
+#define	DMA_INT_TC 		   		0x00000004
+#define	DMA_CFG 		   		0x00000024
+#define	DMA_INT_TC_CLR				0x00000008
+#define	DMA_TC						0x00000014
+#define	DMA_CSR						0x00000024
+#define	DMA_SYNC					0x00000028
+
+#define	DMA_CH2_CSR    				0x00000140
+#define	DMA_CH2_CFG    				0x00000144
+#define	DMA_CH2_SRC_ADDR    		0x00000148
+#define	DMA_CH2_DST_ADDR    		0x0000014c
+#define	DMA_CH2_LLP    				0x00000150
+#define	DMA_CH2_SIZE    			0x00000154
+
+#define	DMA_CH3_CSR    				0x00000160
+#define	DMA_CH3_CFG    				0x00000164
+#define	DMA_CH3_SRC_ADDR    		0x00000168
+#define	DMA_CH3_DST_ADDR    		0x0000016c
+#define	DMA_CH3_LLP    				0x00000170
+#define	DMA_CH3_SIZE    			0x00000174
+
+#define    SSP_DEVICE_ID   			0x00
+#define    SSP_CTRL_STATUS 			0x04
+#define	   SSP_FRAME_CTRL           0x08
+#define    SSP_BAUD_RATE            0x0c
+#define    SSP_FRAME_CTRL2          0x10
+#define    SSP_FIFO_CTRL            0x14
+#define    SSP_TX_SLOT_VALID0       0x18
+#define    SSP_TX_SLOT_VALID1       0x1c
+#define    SSP_TX_SLOT_VALID2       0x20
+#define    SSP_TX_SLOT_VALID3       0x24
+#define    SSP_RX_SLOT_VALID0       0x28
+#define    SSP_RX_SLOT_VALID1       0x2c
+#define    SSP_RX_SLOT_VALID2       0x30
+#define    SSP_RX_SLOT_VALID3       0x34
+#define    SSP_SLOT_SIZE0           0x38
+#define    SSP_SLOT_SIZE1           0x3c
+#define    SSP_SLOT_SIZE2           0x40
+#define    SSP_SLOT_SIZE3           0x44
+#define    SSP_READ_PORT            0x48
+#define    SSP_WRITE_PORT           0x4c
+
+
+
+#define SSP_I2S_INIT_BUF			_IO  ('q', 0x00)
+#define SSP_I2S_STOP_DMA			_IO  ('q', 0x01)
+#define SSP_I2S_FILE_LEN			_IOW  ('q', 0x2, int)
+/*
+#define SSP_GET_HOOK_STATUS			_IOR  ('q', 0xC0, int)
+#define SSP_GET_LINEFEED			_IOR  ('q', 0xC1, int)
+#define SSP_SET_LINEFEED			_IOW  ('q', 0xC2, int)
+#define SSP_GET_REG                 _IOWR ('q', 0xC3, struct Ssp_reg *)
+#define SSP_SET_REG                 _IOWR ('q', 0xC4, struct Ssp_reg *)
+#define SSP_GEN_OFFHOOK_TONE		_IO   ('q', 0xC5)
+#define SSP_GEN_BUSY_TONE			_IO   ('q', 0xC6)
+#define SSP_GEN_RINGBACK_TONE		_IO   ('q', 0xC7)
+#define SSP_GEN_CONGESTION_TONE		_IO   ('q', 0xC8)
+#define SSP_DISABLE_DIALTONE		_IO   ('q', 0xC9)
+#define SSP_PHONE_RING_START		_IO   ('q', 0xCA)
+*/
+
+
+#endif //__GEMINI_I2S_H__
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/gemini_ssp.h
@@ -0,0 +1,263 @@
+/******************************************************************************
+ *    gemini_ssp.h
+ *
+ *
+ *****************************************************************************/
+
+#include <linux/types.h>
+#include <asm/arch-sl2312/irqs.h>
+#include <linux/phonedev.h>
+#include <linux/telephony.h>
+//#include "proslic.h"
+
+typedef __u16 UINT16;
+typedef __u32 UINT32;
+typedef __u8 UINT8;
+typedef __u8 BOOL;
+
+#define TRUE 1
+#define FALSE 0
+
+/***************************************/
+/* define GPIO module base address     */
+/***************************************/
+#define DMA_CONTROL_PHY_BASE  (IO_ADDRESS(SL2312_GENERAL_DMA_BASE))
+#define DMA_CONTROL_SSP_BASE  (IO_ADDRESS(SL2312_SSP_CTRL_BASE))
+#define SSP_INT				IRQ_SSP
+#define GPIO_BASE_ADDR      (IO_ADDRESS(SL2312_GPIO_BASE))
+#define GPIO_BASE_ADDR1      (IO_ADDRESS(SL2312_GPIO_BASE1))
+#define GLOBAL_BASE      (IO_ADDRESS(SL2312_GLOBAL_BASE))
+
+/* define read/write register utility */
+#define READ_SSP_REG(offset)			(__raw_readl(offset+DMA_CONTROL_SSP_BASE))
+#define WRITE_SSP_REG(offset,val) 	(__raw_writel(val,offset+DMA_CONTROL_SSP_BASE))
+
+#define READ_GPIO_REG(offset)			(__raw_readl(offset+GPIO_BASE_ADDR))
+#define WRITE_GPIO_REG(offset,val) 	(__raw_writel(val,offset+GPIO_BASE_ADDR))
+
+#define READ_GPIO1_REG(offset)			(__raw_readl(offset+GPIO_BASE_ADDR1))
+#define WRITE_GPIO1_REG(offset,val) 	(__raw_writel(val,offset+GPIO_BASE_ADDR1))
+
+#define READ_DMA_REG(offset)			(__raw_readl(offset+DMA_CONTROL_PHY_BASE))
+#define WRITE_DMA_REG(offset,val) 	(__raw_writel(val,offset+DMA_CONTROL_PHY_BASE))
+
+#define READ_GLOBAL_REG(offset)			(__raw_readl(offset+GLOBAL_BASE))
+#define WRITE_GLOBAL_REG(offset,val) 	(__raw_writel(val,offset+GLOBAL_BASE))
+
+
+#define SSP_GPIO_INT       	IRQ_GPIO
+
+#ifndef CONFIG_SL3516_ASIC
+#define SSP_GPIO_INT_BIT    0x00000400				//GPIO[10] : SLIC interrupt pin
+
+#define GPIO_EECK	     0x00000040         /*   SCK: GPIO[06]   */
+#define GPIO_EECS	     0x00000080			/*   SCS: GPIO[07]   */
+#define GPIO_MISO	     0x00000200         /*   SDO: GPIO[09]   receive from 6996*/
+#define GPIO_MOSI	     0x00000100         /*   SDI: GPIO[08]   send to 6996*/
+#define GPIO_MISO_BIT	 9
+#else
+#define SSP_GPIO_INT_BIT    0x00000001				//GPIO[0] : SLIC interrupt pin
+
+//#if 0
+//#define GPIO_EECK	     0x80000000         /*   SCK: GPIO1[31]   */
+//#define GPIO_EECS	     0x40000000			/*   SCS: GPIO1[30]   */
+//#define GPIO_MISO	     0x20000000         /*   SDO: GPIO1[29]   receive from 6996*/
+//#define GPIO_MOSI	     0x10000000         /*   SDI: GPIO1[28]   send to 6996*/
+//#define GPIO_MISO_BIT	29
+//#else
+//#define GPIO_EECK	     0x00000100         /*   SCK: GPIO1[08]   */
+//#define GPIO_EECS	     0x08000000			/*   SCS: GPIO1[27]   */
+//#define GPIO_MISO	     0x00000080         /*   SDO: GPIO1[07]   receive from 6996*/
+//#define GPIO_MOSI	     0x00000200         /*   SDI: GPIO1[09]   send to 6996*/
+//#define GPIO_MISO_BIT	7
+//#endif
+#endif
+
+
+enum GPIO_REG
+{
+	GPIO_DATA_OUT   	= 0x00,
+	GPIO_DATA_IN    	= 0x04,
+	GPIO_PIN_DIR    	= 0x08,
+	GPIO_BY_PASS    	= 0x0c,
+	GPIO_DATA_SET   	= 0x10,
+	GPIO_DATA_CLEAR 	= 0x14,
+	GPIO_INT_ENABLE     = 0x20,
+	GPIO_INT_RAWSTATE   = 0x24,
+	GPIO_INT_MASKSTATE  = 0x28,
+	GPIO_INT_MASK       = 0x2C,
+	GPIO_INT_CLEAR      = 0x30,
+	GPIO_INT_TRIGGER    = 0x34,
+	GPIO_INT_BOTH       = 0x38,
+	GPIO_INT_POLARITY   = 0x3C
+};
+
+
+#define SPI_ADD_LEN	     7			// bits of Address
+#define SPI_DAT_LEN	     8			// bits of Data
+
+
+
+//#ifdef MIDWAY_DIAG
+#define	DAISY_MODE	1
+#if (DAISY_MODE==1)
+#define NUMBER_OF_CHAN	2
+#else
+#define NUMBER_OF_CHAN	1
+#endif
+#define LLP_SIZE   8
+#define SBUF_SIZE  512 //0xff0 //2560
+#define DBUF_SIZE  SBUF_SIZE*NUMBER_OF_CHAN //0xff0 //2560
+#define TBUF_SIZE  (LLP_SIZE)*DBUF_SIZE
+#define DESC_NUM   1
+#define DTMF_NUM   20
+
+/* define owner bit of SSP */
+//data into SSP and transfer to AP==> SSP_Rx
+//data out of SSP and transfer to SLIC==> SSP_Tx
+#define CPU		0
+#define DMA		1
+
+#define DMA_DEMO   0
+#define DMA_NDEMO  1
+//#define DMA_NONE   2
+
+enum exceptions {
+	PROSLICiNSANE,
+	TIMEoUTpOWERuP,
+	TIMEoUTpOWERdOWN,
+	POWERlEAK,
+	TIPoRrINGgROUNDsHORT,
+	POWERaLARMQ1,
+	POWERaLARMQ2,
+	POWERaLARMQ3,
+	POWERaLARMQ4,
+	POWERaLARMQ5,
+	OWERaLARMQ6,
+	CM_CAL_ERR
+};
+
+typedef struct
+{
+	UINT32 src_addr;
+	UINT32 dst_addr;
+	UINT32 llp;
+	UINT32 ctrl_size;
+}DMA_LLP_t;
+
+typedef struct {
+	unsigned int own ;
+	char  *tbuf;
+	//UINT32 *LinkAddrT;
+	DMA_LLP_t LLPT[LLP_SIZE];
+}DMA_Tx_t;
+
+typedef struct {
+	unsigned int own ;
+	char  *rbuf;
+	//UINT32 *LinkAddrR;
+	DMA_LLP_t LLPR[LLP_SIZE];
+}DMA_Rx_t;
+
+//typedef struct {
+//	//UINT32 init_stat;
+//	struct chipStruct chipData ; /* Represents a proslics state, cached information, and timers */
+//	struct phone_device p;
+//
+//
+//}SSP_SLIC;
+
+
+
+/* DMA Registers */
+#define	DMA_INT 		   		0x00000000
+#define	DMA_INT_TC 		   		0x00000004
+#define	DMA_CFG 		   		0x00000024
+#define	DMA_INT_TC_CLR				0x00000008
+#define	DMA_TC						0x00000014
+#define	DMA_CSR						0x00000024
+#define	DMA_SYNC					0x00000028
+
+#define	DMA_CH2_CSR    				0x00000140
+#define	DMA_CH2_CFG    				0x00000144
+#define	DMA_CH2_SRC_ADDR    		0x00000148
+#define	DMA_CH2_DST_ADDR    		0x0000014c
+#define	DMA_CH2_LLP    				0x00000150
+#define	DMA_CH2_SIZE    			0x00000154
+
+#define	DMA_CH3_CSR    				0x00000160
+#define	DMA_CH3_CFG    				0x00000164
+#define	DMA_CH3_SRC_ADDR    		0x00000168
+#define	DMA_CH3_DST_ADDR    		0x0000016c
+#define	DMA_CH3_LLP    				0x00000170
+#define	DMA_CH3_SIZE    			0x00000174
+
+#define    SSP_DEVICE_ID   			0x00
+#define    SSP_CTRL_STATUS 			0x04
+#define	   SSP_FRAME_CTRL           0x08
+#define    SSP_BAUD_RATE            0x0c
+#define    SSP_FRAME_CTRL2          0x10
+#define    SSP_FIFO_CTRL            0x14
+#define    SSP_TX_SLOT_VALID0       0x18
+#define    SSP_TX_SLOT_VALID1       0x1c
+#define    SSP_TX_SLOT_VALID2       0x20
+#define    SSP_TX_SLOT_VALID3       0x24
+#define    SSP_RX_SLOT_VALID0       0x28
+#define    SSP_RX_SLOT_VALID1       0x2c
+#define    SSP_RX_SLOT_VALID2       0x30
+#define    SSP_RX_SLOT_VALID3       0x34
+#define    SSP_SLOT_SIZE0           0x38
+#define    SSP_SLOT_SIZE1           0x3c
+#define    SSP_SLOT_SIZE2           0x40
+#define    SSP_SLOT_SIZE3           0x44
+#define    SSP_READ_PORT            0x48
+#define    SSP_WRITE_PORT           0x4c
+
+
+void printFreq_Revision(int num);
+void SLIC_SPI_write(int num, UINT8 ,UINT8);
+UINT8 SLIC_SPI_read(int num, UINT8);
+void SLIC_SPI_write_bit(char);
+void SLIC_SPI_ind_write(int num, UINT8, UINT16);
+UINT16 SLIC_SPI_ind_read(int num, UINT8);
+void SLIC_SPI_CS_enable(UINT8);
+unsigned int SLIC_SPI_read_bit(void);
+void SLIC_SPI_pre_st(void);
+UINT32 ssp_init(void);
+UINT16 SLIC_SPI_get_identifier(int num);
+int selfTest(int num);
+void exception (int num, enum exceptions e);
+int SLIC_init(int num);
+UINT8 version(int num);
+UINT8 chipType (int num);
+void SLIC_init_ind_reg_set(int num);
+UINT8 powerUp(int num);
+UINT8 powerLeakTest(int num);
+void SLIC_init_reg_set(int num);
+int calibrate(int num);
+void goActive(int num);
+void clearInterrupts(int num);
+void setState(int num, int);
+UINT8 loopStatus(int num);
+int verifyIndirectRegisters(int num);
+int verifyIndirectReg(int num, UINT8 , UINT16);
+void sendProSLICID(int num);
+void disableOscillators(int num);
+UINT8 checkSum(int num, char * string );
+void fskInitialization (int num);
+void fskByte(int num, UINT8 c);
+void waitForInterrupt (int num);
+//void findNumber(void);
+UINT8 dtmfAction(int num);
+UINT8 digit(int num);
+void interrupt_init(void);
+//void gemini_slic_isr (int );
+int groundShort(int num);
+void clearAlarmBits(int num);
+void stopRinging(int num);
+void activateRinging(int num);
+void initializeLoopDebounceReg(int num);
+void busyJapan(int num) ;
+void ringBackJapan(int num) ;
+void stateMachine(int num);
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/hardware.h
@@ -0,0 +1,47 @@
+/*
+ *  linux/include/asm-arm/arch-epxa10/hardware.h
+ *
+ *  This file contains the hardware definitions of the Integrator.
+ *
+ *  Copyright (C) 1999 ARM Limited.
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#ifndef __ASM_ARCH_HARDWARE_H
+#define __ASM_ARCH_HARDWARE_H
+
+#include <asm/arch/platform.h>
+
+#define pcibios_assign_all_busses()	1
+
+/*
+ * Where in virtual memory the IO devices (timers, system controllers
+ * and so on)
+ *
+ * macro to get at IO space when running virtually
+*/
+
+#define IO_ADDRESS(x)      (((x&0xfff00000)>>4)|(x & 0x000fffff)|0xF0000000)
+#define FLASH_VBASE         0xFE000000
+#define FLASH_SIZE 0x1000000// 8M
+#define FLASH_START         SL2312_FLASH_BASE
+#define FLASH_VADDR(x)      ((x & 0x00ffffff)|0xFE000000)       // flash virtual address
+
+#define PCIBIOS_MIN_IO					0x100		// 0x000-0x100 AHB reg and PCI config, data
+#define PCIBIOS_MIN_MEM					0
+
+#endif
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/int_ctrl.h
@@ -0,0 +1,171 @@
+/*
+ *
+ *  This file contains the register definitions for the Excalibur
+ *  Timer TIMER00.
+ *
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+
+#ifndef __INT_CTRL_H
+#define __INT_CTRL_H
+
+#define PCI_IRQ_OFFSET			  64    /* PCI start IRQ number */
+#define FIQ_OFFSET                32
+
+#define IRQ_SOURCE(base_addr)   (INT_CTRL_TYPE(base_addr  + 0x00))
+#define IRQ_MASK(base_addr)     (INT_CTRL_TYPE (base_addr  + 0x04 ))
+#define IRQ_CLEAR(base_addr)    (INT_CTRL_TYPE (base_addr  + 0x08 ))
+#define IRQ_TMODE(base_addr)    (INT_CTRL_TYPE (base_addr  + 0x0C ))
+#define IRQ_TLEVEL(base_addr)    (INT_CTRL_TYPE (base_addr  + 0x10 ))
+#define IRQ_STATUS(base_addr)   (INT_CTRL_TYPE (base_addr  + 0x14 ))
+#define FIQ_SOURCE(base_addr)   (INT_CTRL_TYPE (base_addr  + 0x20 ))
+#define FIQ_MASK(base_addr)     (INT_CTRL_TYPE (base_addr  + 0x24 ))
+#define FIQ_CLEAR(base_addr)    (INT_CTRL_TYPE (base_addr  + 0x28 ))
+#define FIQ_TMODE(base_addr)    (INT_CTRL_TYPE (base_addr  + 0x2C ))
+#define FIQ_LEVEL(base_addr)    (INT_CTRL_TYPE (base_addr  + 0x30 ))
+#define FIQ_STATUS(base_addr)   (INT_CTRL_TYPE (base_addr  + 0x34 ))
+
+#ifdef CONFIG_SL3516_ASIC
+#define	IRQ_SERIRQ0_OFFSET                 	30
+#define	IRQ_PCID_OFFSET	                 	29
+#define	IRQ_PCIC_OFFSET	                 	28
+#define	IRQ_PCIB_OFFSET	                 	27
+#define IRQ_PWR_OFFSET				    	26
+#define IRQ_CIR_OFFSET						25
+#define	IRQ_GPIO2_OFFSET                   	24
+#define	IRQ_GPIO1_OFFSET                   	23
+#define	IRQ_GPIO_OFFSET	                	22
+#define	IRQ_SSP_OFFSET                     	21
+#define IRQ_LPC_OFFSET                      20
+#define IRQ_LCD_OFFSET                      19
+#define	IRQ_UART_OFFSET                		18
+#define	IRQ_RTC_OFFSET             			17
+#define	IRQ_TIMER3_OFFSET                  	16
+#define	IRQ_TIMER2_OFFSET                  	15
+#define	IRQ_TIMER1_OFFSET                  	14
+#define IRQ_FLASH_OFFSET					12
+#define	IRQ_USB1_OFFSET                    	11
+#define IRQ_USB0_OFFSET						10
+#define	IRQ_DMA_OFFSET                     	9
+#define	IRQ_PCI_OFFSET                 		8
+#define	IRQ_IPSEC_OFFSET            		7
+#define	IRQ_RAID_OFFSET                     6
+#define	IRQ_IDE1_OFFSET                    	5
+#define	IRQ_IDE0_OFFSET                		4
+#define	IRQ_WATCHDOG_OFFSET                 3
+#define	IRQ_GMAC1_OFFSET                    2
+#define IRQ_GMAC0_OFFSET					1
+#define	IRQ_CPU0_IP_IRQ_OFFSET              0
+
+#define	IRQ_SERIRQ0_MASK                 	(1<<30)
+#define IRQ_PCID_MASK				    	(1<<29)
+#define IRQ_PCIC_MASK				    	(1<<28)
+#define IRQ_PCIB_MASK				    	(1<<27)
+#define IRQ_PWR_MASK				    	(1<<26)
+#define IRQ_CIR_MASK						(1<<25)
+#define	IRQ_GPIO2_MASK                   	(1<<24)
+#define	IRQ_GPIO1_MASK                    	(1<<23)
+#define	IRQ_GPIO_MASK	                    (1<<22)
+#define	IRQ_SSP_MASK                        (1<<21)
+#define IRQ_LPC_MASK                        (1<<20)
+#define IRQ_LCD_MASK                        (1<<19)
+#define	IRQ_UART_MASK                	    (1<<18)
+#define	IRQ_RTC_MASK             		    (1<<17)
+#define	IRQ_TIMER3_MASK                     (1<<16)
+#define	IRQ_TIMER2_MASK                     (1<<15)
+#define	IRQ_TIMER1_MASK                     (1<<14)
+#define IRQ_FLASH_MASK					    (1<<12)
+#define	IRQ_USB1_MASK                       (1<<11)
+#define IRQ_USB0_MASK					    (1<<10)
+#define	IRQ_DMA_MASK                        (1<< 9)
+#define	IRQ_PCI_MASK                 	    (1<< 8)
+#define	IRQ_IPSEC_MASK            		    (1<< 7)
+#define	IRQ_RAID_MASK                       (1<< 6)
+#define	IRQ_IDE1_MASK                       (1<< 5)
+#define	IRQ_IDE0_MASK                 	    (1<< 4)
+#define	IRQ_WATCHDOG_MASK                   (1<< 3)
+#define	IRQ_GMAC1_MASK                      (1<< 2)
+#define IRQ_GMAC0_MASK					    (1<< 1)
+#define	IRQ_CPU0_IP_IRQ_MASK                (1<< 0)
+#else
+#define	IRQ_SERIRQ0_OFFSET                 	30
+#define	IRQ_PCID_OFFSET	                 	29
+#define	IRQ_PCIC_OFFSET	                 	28
+#define	IRQ_PCIB_OFFSET	                 	27
+#define IRQ_PWR_OFFSET				    	26
+#define IRQ_CIR_OFFSET						25
+#define	IRQ_GPIO2_OFFSET                   	24
+#define	IRQ_GPIO1_OFFSET                   	23
+#define	IRQ_GPIO_OFFSET	                	22
+#define	IRQ_SSP_OFFSET                     	21
+#define IRQ_LPC_OFFSET                      20
+#define IRQ_LCD_OFFSET                      19
+#define	IRQ_UART_OFFSET                		18
+#define	IRQ_RTC_OFFSET             			17
+#define	IRQ_TIMER3_OFFSET                  	16
+#define	IRQ_TIMER2_OFFSET                  	15
+#define	IRQ_TIMER1_OFFSET                  	14
+#define IRQ_FLASH_OFFSET					12
+#define	IRQ_USB1_OFFSET                    	11
+#define IRQ_USB0_OFFSET						10
+#define	IRQ_DMA_OFFSET                     	9
+#define	IRQ_PCI_OFFSET                 		8
+#define	IRQ_IPSEC_OFFSET            		7
+#define	IRQ_RAID_OFFSET                     6
+#define	IRQ_IDE1_OFFSET                    	5
+#define	IRQ_IDE0_OFFSET                		4
+#define	IRQ_WATCHDOG_OFFSET                 3
+#define	IRQ_GMAC1_OFFSET                    2
+#define IRQ_GMAC0_OFFSET					1
+#define	IRQ_CPU0_IP_IRQ_OFFSET              0
+
+#define	IRQ_SERIRQ0_MASK                 	(1<<30)
+#define IRQ_PCID_MASK				    	(1<<29)
+#define IRQ_PCIC_MASK				    	(1<<28)
+#define IRQ_PCIB_MASK				    	(1<<27)
+#define IRQ_PWR_MASK				    	(1<<26)
+#define IRQ_CIR_MASK						(1<<25)
+#define	IRQ_GPIO2_MASK                   	(1<<24)
+#define	IRQ_GPIO1_MASK                    	(1<<23)
+#define	IRQ_GPIO_MASK	                    (1<<22)
+#define	IRQ_SSP_MASK                        (1<<21)
+#define IRQ_LPC_MASK                        (1<<20)
+#define IRQ_LCD_MASK                        (1<<19)
+#define	IRQ_UART_MASK                	    (1<<18)
+#define	IRQ_RTC_MASK             		    (1<<17)
+#define	IRQ_TIMER3_MASK                     (1<<16)
+#define	IRQ_TIMER2_MASK                     (1<<15)
+#define	IRQ_TIMER1_MASK                     (1<<14)
+#define IRQ_FLASH_MASK					    (1<<12)
+#define	IRQ_USB1_MASK                       (1<<11)
+#define IRQ_USB0_MASK					    (1<<10)
+#define	IRQ_DMA_MASK                        (1<< 9)
+#define	IRQ_PCI_MASK                 	    (1<< 8)
+#define	IRQ_IPSEC_MASK            		    (1<< 7)
+#define	IRQ_RAID_MASK                       (1<< 6)
+#define	IRQ_IDE1_MASK                       (1<< 5)
+#define	IRQ_IDE0_MASK                 	    (1<< 4)
+#define	IRQ_WATCHDOG_MASK                   (1<< 3)
+#define	IRQ_GMAC1_MASK                      (1<< 2)
+#define IRQ_GMAC0_MASK					    (1<< 1)
+#define	IRQ_CPU0_IP_IRQ_MASK                (1<< 0)
+#endif
+
+
+#endif /* __INT_CTRL_H */
+
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/io.h
@@ -0,0 +1,50 @@
+/*
+ *  linux/include/asm-arm/arch-epxa10db/io.h
+ *
+ *  Copyright (C) 1999 ARM Limited
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#ifndef __ASM_ARM_ARCH_IO_H
+#define __ASM_ARM_ARCH_IO_H
+
+#define IO_SPACE_LIMIT 0xffffffff
+
+
+/*
+ * Generic virtual read/write
+ */
+/*
+#define __arch_getw(a)		(*(volatile unsigned short *)(a))
+#define __arch_putw(v,a)	(*(volatile unsigned short *)(a) = (v))
+*/
+/*#define outsw   __arch_writesw
+#define outsl   __arch_writesl
+#define outsb   __arch_writesb
+#define insb    __arch_readsb
+#define insw    __arch_readsw
+#define insl    __arch_readsl*/
+
+#define __io(a)			(a)
+#define __mem_pci(a)            (a)
+/*
+#define __arch_getw(a)			(*(volatile unsigned short  *)(a))
+#define __arch_putw(v,a)		(*(volatile unsigned short *)(a) = (v))
+*/
+#define iomem_valid_addr(off,size) (1)
+#define iomem_to_phys(off) (off)
+
+
+#endif
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/ipi.h
@@ -0,0 +1,189 @@
+/*
+ *  linux/include/asm-arm/arch-sl2312/system.h
+ *
+ *  Copyright (C) 1999 ARM Limited
+ *  Copyright (C) 2000 Deep Blue Solutions Ltd
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#ifndef __ASM_ARCH_IPI_H
+#define __ASM_ARCH_IPI_H
+#include <asm/io.h>
+
+//#define spin_lock(x)	spin_lock_dt(x)
+//#define spin_unlock(x)	spin_unlock_dt(x)
+
+#define SWAP_OFFSET							0x400000
+#define SWAP_SIZE							0x400000
+
+#define SHARE_MEM_ADDR						0x2000000
+#define SHARE_MEM_SIZE						1024*1024
+
+
+//--> Add by jason for IPI testing
+// memory layout for maste & slave bin
+#define MASTERTEXT      0x8000
+#define SLAVETEXT		0x108000
+#define SHARESIZE		0x4000
+#define SHAREADDR		SHARE_MEM_ADDR // starting 8M
+
+// CPU1 reset release
+#define GLOBAL_BASE		IO_ADDRESS(0x40000000)
+#define GLOBAL_SOFTRESET	(GLOBAL_BASE + 0x0C)
+#define CPU1_RESET_BIT_MASK     0x40000000
+
+// IPI , need to redefine the folliwing,  bug
+#define CPU0_STATUS			(GLOBAL_BASE + 0x0038)
+#define CPU1_STATUS			(GLOBAL_BASE + 0x003C)
+#define CPU_IPI_BIT_MASK    0x80000000
+
+/* Your basic SMP spinlocks, allowing only a single CPU anywhere
+*/
+typedef struct {
+       volatile unsigned int lock;
+} spinlock_dt;
+
+
+#define         MASTER_BIT      0x01
+#define         SLAVE_BIT       0x02
+#define         HEART_BIT       0x04
+#define         IPI0_IRQ_BIT    0x08
+#define         IPI0_FIQ_BIT    0x10
+#define         IPI1_IRQ_BIT    0x20
+#define         IPI1_FIQ_BIT    0x40
+
+#define IRQ     0
+#define FIQ     1
+#define DONE    0xff
+
+#define         CPU0            0x0
+#define         CPU1            0x1
+
+#define         MAXCHAR         128*1024
+typedef struct  {
+       int flag;
+       int uart_flag;
+       int cnt;
+       spinlock_dt lk;
+       char message[MAXCHAR];
+}s_mailbox;
+
+// JScale proj definition
+typedef struct {
+	u16		type;				// message Type
+	u16		length;				// message length, including message header
+} IPC_MSG_HDR_T;
+
+typedef struct{
+	IPC_MSG_HDR_T	hdr;
+	u32				input_location;
+	u32				input_size;
+	u32				output_location;
+	u16  			ScaledImageWidth;
+	u16  			ScaledImageHeight;
+	u8  			ScaledImageQuality;
+	u8  			MaintainResultionRatio;
+	u8  			TwoStepScaling;
+	u8  			InputFormat;
+	u8				verbose;
+	u8				reserved[3];
+} JSCALE_REQ_T;
+
+typedef struct{
+	IPC_MSG_HDR_T	hdr;
+	u32				status;
+	u32				code;
+	u32				output_size;
+} JSCALE_RSP_T;
+
+#define IPC_JSCALE_REQ_MSG			0	// JScale request from CPU-0 to CPU-1
+#define IPC_JSCALE_RSP_MSG			1	// JScale response from CPU-1 to CPU-0
+
+enum {
+	JSCALE_STATUS_OK = 0,
+	JSCALE_UNKNOWN_MSG_TYPE,
+	JSCALE_FAILED_FILE_SIZE,
+	JSCALE_FAILED_MALLOC,
+	JSCALE_FAILED_FORMAT,
+	JSCALE_DECODE_ERROR,
+	JSCALE_BUSY,
+};
+// <-- JScale
+
+#define GEMINI_IPI_IOCTL_BASE	'Z'
+#define GEMINI_IPI_JSCALE_REQ		_IOW (GEMINI_IPI_IOCTL_BASE,0,JSCALE_REQ_T)
+#define GEMINI_IPI_JSCALE_STAT		_IOR (GEMINI_IPI_IOCTL_BASE,1,JSCALE_RSP_T)
+
+
+/*
+* Simple spin lock operations.
+*
+*/
+
+#define spin_is_locked_dt(x)((x)->lock != 0)
+
+static inline int test_and_set_dt(spinlock_dt *lock)
+{
+unsigned long tmp;
+__asm__ __volatile__(
+"swp     %0, %2, [%1]\n"
+: "=&r" (tmp)
+: "r" (&lock->lock), "r" (1)
+: "cc", "memory");
+
+return tmp;
+}
+
+static inline void spin_lock_dt(spinlock_dt *lock)
+{
+
+unsigned long tmp;
+__asm__ __volatile__(
+"1:     ldr   %0, [%1]\n"
+"teq     %0, #0\n"
+"swpeq   %0, %2, [%1]\n"
+"       teqeq   %0, #0\n"
+"       bne     1b"
+       : "=&r" (tmp)
+       : "r" (&lock->lock), "r" (1)
+       : "cc", "memory");
+}
+
+static inline void spin_unlock_dt(spinlock_dt *lock)
+{
+       __asm__ __volatile__(
+"       str     %1, [%0]"
+       :
+       : "r" (&lock->lock), "r" (0)
+       : "cc", "memory");
+}
+
+static inline int getcpuid(void)
+{
+       int cpuid;
+
+      __asm__(
+"mrc p8, 0, r0, c0, c0, 0\n"
+"mov %0, r0"
+       :"=r"(cpuid)
+       :
+       :"r0");
+       return (cpuid & 0x07);
+}
+
+
+
+#endif
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/irq.h
@@ -0,0 +1,23 @@
+/*
+ *  linux/include/asm-arm/arch-sl2312/irq.h
+ *
+ *  Copyright (C) 1999 ARM Limited
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+
+ // Since we have PCI interrupt which the interrupt line is pseudo
+ // we need do some fixup
+int fixup_irq(int irq);
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/irqs.h
@@ -0,0 +1,102 @@
+/*
+ *  linux/include/asm-arm/arch-camelot/irqs.h
+ *
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+
+/* Use the Excalibur chip definitions */
+#define INT_CTRL_TYPE
+#include "asm/arch/int_ctrl.h"
+
+#ifdef CONFIG_SL3516_ASIC
+#define	IRQ_SERIRQ_MAX					31
+#define	IRQ_SERIRQ1						31
+#define	IRQ_SERIRQ0                  	30
+#define	IRQ_PCID 	                  	29
+#define	IRQ_PCIC    	             	28
+#define	IRQ_PCIB        	         	27
+#define IRQ_PWR							26
+#define IRQ_CIR							25
+#define	IRQ_GPIO2                   	24
+#define	IRQ_GPIO1                   	23
+#define	IRQ_GPIO	                	22
+#define	IRQ_SSP                     	21
+#define IRQ_LPC                         20
+#define IRQ_LCD                         19
+#define	IRQ_UART                  		18
+#define	IRQ_RTC                			17
+#define	IRQ_TIMER3                  	16
+#define	IRQ_TIMER2                    	15
+#define	IRQ_TIMER1                    	14
+#define IRQ_FLASH						12
+#define	IRQ_USB1                    	11
+#define IRQ_USB0						10
+#define	IRQ_DMA                     	9
+#define	IRQ_PCI                    		8
+#define	IRQ_IPSEC              			7
+#define	IRQ_RAID                        6
+#define	IRQ_IDE1                    	5
+#define	IRQ_IDE0                   		4
+#define	IRQ_WATCHDOG                    3
+#define	IRQ_GMAC1                       2
+#define IRQ_GMAC0						1
+#define	IRQ_CPU0_IP_IRQ                 0
+#else
+#define	IRQ_SERIRQ_MAX					31
+#define	IRQ_SERIRQ1						31
+#define	IRQ_SERIRQ0                  	30
+#define	IRQ_PCID 	                  	29
+#define	IRQ_PCIC    	             	28
+#define	IRQ_PCIB        	         	27
+#define IRQ_PWR							26
+#define IRQ_CIR							25
+#define	IRQ_GPIO2                   	24
+#define	IRQ_GPIO1                   	23
+#define	IRQ_GPIO	                	22
+#define	IRQ_SSP                     	21
+#define IRQ_LPC                         20
+#define IRQ_LCD                         19
+#define	IRQ_UART                  		18
+#define	IRQ_RTC                			17
+#define	IRQ_TIMER3                  	16
+#define	IRQ_TIMER2                    	15
+#define	IRQ_TIMER1                    	14
+#define IRQ_FLASH						12
+#define	IRQ_USB1                    	11
+#define IRQ_USB0						10
+#define	IRQ_DMA                     	9
+#define	IRQ_PCI                    		8
+#define	IRQ_IPSEC              			7
+#define	IRQ_RAID                        6
+#define	IRQ_IDE1                    	5
+#define	IRQ_IDE0                   		4
+#define	IRQ_WATCHDOG                    3
+#define	IRQ_GMAC1                       2
+#define IRQ_GMAC0						1
+#endif
+
+#define ARCH_TIMER_IRQ		               IRQ_TIMER2   /* for MV 4.0 */
+
+#define IRQ_PCI_INTA				       PCI_IRQ_OFFSET + 0
+#define IRQ_PCI_INTB				       PCI_IRQ_OFFSET + 1
+#define IRQ_PCI_INTC				       PCI_IRQ_OFFSET + 2
+#define IRQ_PCI_INTD				       PCI_IRQ_OFFSET + 3
+
+#define NR_IRQS                           (IRQ_PCI_INTD + 4)
+
+
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/it8712.h
@@ -0,0 +1,24 @@
+
+#ifndef __IT8712_H__
+#define __IT8712_H__
+
+#include "asm/arch/sl2312.h"
+
+#define IT8712_IO_BASE			SL2312_LPC_IO_BASE
+// Device LDN
+#define LDN_SERIAL1				0x01
+#define LDN_SERIAL2				0x02
+#define LDN_PARALLEL			0x03
+#define LDN_KEYBOARD			0x05
+#define LDN_MOUSE				0x06
+#define LDN_GPIO				0x07
+
+#define IT8712_UART1_PORT      	0x3F8
+#define IT8712_UART2_PORT      	0x2F8
+
+#define IT8712_GPIO_BASE		0x800	// 0x800-0x804 for GPIO set1-set5
+
+void LPCSetConfig(char LdnNumber, char Index, char data);
+char LPCGetConfig(char LdnNumber, char Index);
+
+#endif
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/memory.h
@@ -0,0 +1,38 @@
+/*
+ *  linux/include/asm-arm/arch-sl2312/memory.h
+ *
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#ifndef __ASM_ARCH_MMU_H
+#define __ASM_ARCH_MMU_H
+
+/*
+ * Physical DRAM offset.
+ */
+#define PHYS_OFFSET	UL(0x00000000)
+
+/*
+ * Virtual view <-> DMA view memory address translations
+ * virt_to_bus: Used to translate the virtual address to an
+ *              address suitable to be passed to set_dma_addr
+ * bus_to_virt: Used to convert an address for DMA operations
+ *              to an address that the kernel can use.
+ */
+#define __virt_to_bus(x)	(x - PAGE_OFFSET + /*SDRAM_BASE*/0)
+#define __bus_to_virt(x)	(x - /*SDRAM_BASE*/0 + PAGE_OFFSET)
+
+#endif
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/param.h
@@ -0,0 +1,20 @@
+/*
+ *  linux/include/asm-arm/arch-epxa10db/param.h
+ *
+ *  Copyright (C) 1999 ARM Limited
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/pci.h
@@ -0,0 +1,18 @@
+
+#ifndef __SL2312_PCI_H__
+#define __SL2312_PCI_H__
+
+#define SL2312_PCI_PMC				0x40
+#define SL2312_PCI_PMCSR			0x44
+#define SL2312_PCI_CTRL1			0x48
+#define SL2312_PCI_CTRL2			0x4c
+#define SL2312_PCI_MEM1_BASE_SIZE	0x50
+#define SL2312_PCI_MEM2_BASE_SIZE	0x54
+#define SL2312_PCI_MEM3_BASE_SIZE	0x58
+
+
+void sl2312_pci_mask_irq(unsigned int irq);
+void sl2312_pci_unmask_irq(unsigned int irq);
+int sl2312_pci_get_int_src(void);
+
+#endif
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/platform.h
@@ -0,0 +1,7 @@
+#ifndef PLATFORM_H
+#define PLATFORM_H
+#include "sl2312.h"
+
+#define MAXIRQNUM 68
+#endif
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/preempt.h
@@ -0,0 +1,63 @@
+/*
+ * include/asm-arm/arch-sl2312/preempt.h
+ *
+ * Timing support for preempt-stats, kfi, ilatency patches
+ *
+ * Author: dsingleton <dsingleton@mvista.com>
+ *
+ * 2001-2004 (c) MontaVista Software, Inc. This file is licensed under
+ * the terms of the GNU General Public License version 2. This program
+ * is licensed "as is" without any warranty of any kind, whether express
+ * or implied.
+ */
+
+#ifndef _ASM_ARCH_PREEMT_H
+#define _ASM_ARCH_PREEMT_H
+
+#include <asm/arch/hardware.h>
+#include <asm/arch/sl2312.h>
+
+static inline unsigned long clock_diff(unsigned long start, unsigned long stop)
+{
+        return (start - stop);
+}
+
+static inline unsigned int readclock(void)
+{
+	unsigned int	x;
+
+	x = readl(IO_ADDRESS(SL2312_TIMER2_BASE));
+	return x;
+}
+
+static inline unsigned __ticks_per_usec(void)
+{
+#ifdef CONFIG_SL3516_ASIC
+	unsigned int ahb_clock_rate_base=130;  /* unit = MHz*/
+	unsigned int reg_v=0;
+	unsigned int ticks_usec;
+
+	reg_v = readl(IO_ADDRESS((SL2312_GLOBAL_BASE+4)));
+	reg_v >>=15;
+	ticks_usec = (ahb_clock_rate_base + (reg_v & 0x07)*10)>>2;
+
+#else
+	unsigned int ticks_usec=20;
+#endif
+
+    return ticks_usec;
+}
+
+/*
+ * timer 1 runs @ 6Mhz  6 ticks = 1 microsecond
+ * and is configed as a count down timer.
+ */
+#define TICKS_PER_USEC		    __ticks_per_usec()
+#define ARCH_PREDEFINES_TICKS_PER_USEC
+
+#define clock_to_usecs(x)	    ((x) / TICKS_PER_USEC)
+
+#define INTERRUPTS_ENABLED(x)   (!(x & PSR_I_BIT))
+
+#endif
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/sl2312.h
@@ -0,0 +1,254 @@
+#ifndef __sl2312_h
+#define __sl2312_h
+
+/****************************************************************************
+ * Copyright  Storlink Corp 2002-2003.  All rights reserved.                *
+ *--------------------------------------------------------------------------*
+ * Name:board.s                                                             *
+ * Description:  SL231x specfic define                                      *
+ * Author: Plus Chen                                                        *
+ * Version: 0.9 Create
+ ****************************************************************************/
+
+/*
+  CPE address map;
+
+               +====================================================
+    0x00000000 | FLASH
+    0x0FFFFFFF |
+               |====================================================
+    0x10000000 | SDRAM
+    0x1FFFFFFF |
+               |====================================================
+    0x20000000 | Global Registers        0x20000000-0x20FFFFFF
+               | EMAC and DMA            0x21000000-0x21FFFFFF
+               | UART Module             0x22000000-0x22FFFFFF
+               | Timer Module            0x23000000-0x23FFFFFF
+               | Interrupt Module        0x24000000-0x24FFFFFF
+               | RTC Module              0x25000000-0x25FFFFFF
+               | LPC Host Controller     0x26000000-0x26FFFFFF
+               | LPC Peripherial IO      0x27000000-0x27FFFFFF
+               | WatchDog Timer          0x28000000-0x28FFFFFF
+    0x2FFFFFFF | Reserved                0x29000000-0x29FFFFFF
+               |=====================================================
+    0x30000000 | PCI IO, Configuration Registers
+    0x3FFFFFFF |
+               |=====================================================
+    0x40000000 | PCI Memory
+    0x4FFFFFFF |
+               |=====================================================
+    0x50000000 | Ethernet MAC and DMA    0x50000000-0x50FFFFFF
+               | Security and DMA        0x51000000-0x51FFFFFF
+               | IDE Channel 0 Register  0x52000000-0x527FFFFF
+               | IDE Channel 1 Register  0x52800000-0x52FFFFFF
+               | USB Register            0x53000000-0x53FFFFFF
+               | Flash Controller        0x54000000-0x54FFFFFF
+               | DRAM Controller         0x55000000-0x55FFFFFF
+    0x5FFFFFFF | Reserved                0x56000000-0x5FFFFFFF
+               |=====================================================
+    0x60000000 | Reserved
+    0x6FFFFFFF |
+               |=====================================================
+    0x70000000 | FLASH shadow Memory
+    0x7FFFFFFF |
+               |=====================================================
+    0x80000000 | Big Endian of memory    0x00000000-0x7FFFFFFF
+    0xFFFFFFFF |
+               +=====================================================
+*/
+
+
+
+/*-------------------------------------------------------------------------------
+ Memory Map definitions
+-------------------------------------------------------------------------------- */
+#define TEST		1
+#if 0
+
+static inline int GETCPUID()
+{
+       int cpuid;
+      __asm__(
+"mrc p8, 0, r0, c0, c0, 0\n"
+"mov %0, r0"
+       :"=r"(cpuid)
+       :
+       :"r0");
+       return (cpuid & 0x07);
+}
+#endif
+#define SL2312_SRAM_BASE                0x70000000       //  SRAM base after remap
+#define SL2312_DRAM_BASE                0x00000000       //  DRAM base after remap
+#define SL2312_RAM_BASE                 0x10000000       //  RAM code base before remap
+#define SL2312_FLASH_BASE         	    0x30000000
+#define SL2312_ROM_BASE                 0x30000000
+#define SL2312_GLOBAL_BASE              0x40000000
+#define SL2312_WAQTCHDOG_BASE           0x41000000
+#define SL2312_UART_BASE                0x42000000
+#define SL2312_TIMER_BASE               0x43000000
+#define SL2312_LCD_BASE                 0x44000000
+#define SL2312_RTC_BASE                 0x45000000
+#define SL2312_SATA_BASE                0x46000000
+#define SL2312_LPC_HOST_BASE            0x47000000
+#define SL2312_LPC_IO_BASE              0x47800000
+// #define SL2312_INTERRUPT_BASE           0x48000000
+#define SL2312_INTERRUPT0_BASE          0x48000000
+#define SL2312_INTERRUPT1_BASE          0x49000000
+//#define SL2312_INTERRUPT_BASE		((getcpuid()==0)?SL2312_INTERRUPT0_BASE:SL2312_INTERRUPT1_BASE)
+#define SL2312_INTERRUPT_BASE		    0x48000000
+#define SL2312_SSP_CTRL_BASE            0x4A000000
+#define SL2312_POWER_CTRL_BASE          0x4B000000
+#define SL2312_CIR_BASE                 0x4C000000
+#define SL2312_GPIO_BASE                0x4D000000
+#define SL2312_GPIO_BASE1               0x4E000000
+#define SL2312_GPIO_BASE2               0x4F000000
+#define SL2312_PCI_IO_BASE              0x50000000
+#define SL2312_PCI_MEM_BASE             0x58000000
+#ifdef  CONFIG_NET_SL351X
+#define SL2312_TOE_BASE                 0x60000000
+#define SL2312_GMAC0_BASE               0x6000A000
+#define SL2312_GMAC1_BASE               0x6000E000
+#else
+#define SL2312_GMAC0_BASE               0x60000000
+#define SL2312_GMAC1_BASE               0x61000000
+#endif
+#define SL2312_SECURITY_BASE            0x62000000
+#define SL2312_IDE0_BASE                0x63000000
+#define SL2312_IDE1_BASE		        0x63400000
+#define SL2312_RAID_BASE                0x64000000
+#define SL2312_FLASH_CTRL_BASE          0x65000000
+#define SL2312_DRAM_CTRL_BASE           0x66000000
+#define SL2312_GENERAL_DMA_BASE         0x67000000
+#define SL2312_USB_BASE                 0x68000000
+#define SL2312_USB0_BASE                0x68000000
+#define SL2312_USB1_BASE                0x69000000
+#define SL2312_FLASH_SHADOW             0x30000000
+#define SL2312_BIG_ENDIAN_BASE			0x80000000
+
+#ifdef CONFIG_GEMINI_IPI
+#define CPU_1_MEM_BASE			0x4000000				// 64 MB
+#define CPU_1_DATA_OFFSET		0x4000000-0x300000		// Offset 61 MB
+#endif
+
+#define SL2312_TIMER1_BASE              SL2312_TIMER_BASE
+#define SL2312_TIMER2_BASE              (SL2312_TIMER_BASE + 0x10)
+#define SL2312_TIMER3_BASE              (SL2312_TIMER_BASE + 0x20)
+
+#define SL2312_PCI_DMA_MEM1_BASE		0x00000000
+#define SL2312_PCI_DMA_MEM2_BASE		0x00000000
+#define SL2312_PCI_DMA_MEM3_BASE		0x00000000
+#define SL2312_PCI_DMA_MEM1_SIZE		7
+#define SL2312_PCI_DMA_MEM2_SIZE		6
+#define SL2312_PCI_DMA_MEM3_SIZE		6
+
+/*-------------------------------------------------------------------------------
+ Global Module
+---------------------------------------------------------------------------------*/
+#define GLOBAL_ID                       0x00
+#define GLOBAL_CHIP_ID                  0x002311
+#define GLOBAL_CHIP_REV                 0xA0
+#define GLOBAL_STATUS                   0x04
+#define GLOBAL_CONTROL                  0x1C
+#define GLOBAL_REMAP_BIT                0x01
+#define GLOBAL_RESET_REG		0x0C
+#define GLOBAL_MISC_REG					0x30
+#define PFLASH_SHARE_BIT				0x02
+
+#define GLOBAL_RESET		(1<<31)
+#define RESET_CPU1			(1<<30)
+#define RESET_SATA1			(1<<27)
+#define RESET_SATA0			(1<<26)
+#define RESET_CIR			(1<<25)
+#define RESET_EXT_DEV		(1<<24)
+#define RESET_WD			(1<<23)
+#define RESET_GPIO2			(1<<22)
+#define RESET_GPIO1			(1<<21)
+#define RESET_GPIO0			(1<<20)
+#define RESET_SSP			(1<<19)
+#define RESET_UART			(1<<18)
+#define RESET_TIMER			(1<<17)
+#define RESET_RTC			(1<<16)
+#define RESET_INT0			(1<<15)
+#define RESET_INT1			(1<<14)
+#define RESET_LCD			(1<<13)
+#define RESET_LPC			(1<<12)
+#define RESET_APB			(1<<11)
+#define RESET_DMA			(1<<10)
+#define RESET_USB1			(1<<9 )
+#define RESET_USB0			(1<<8 )
+#define RESET_PCI			(1<<7 )
+#define RESET_GMAC1			(1<<6 )
+#define RESET_GMAC0			(1<<5 )
+#define RESET_IPSEC			(1<<4 )
+#define RESET_RAID			(1<<3 )
+#define RESET_IDE			(1<<2 )
+#define RESET_FLASH			(1<<1 )
+#define RESET_DRAM			(1<<0 )
+
+
+
+
+
+
+
+
+/*-------------------------------------------------------------------------------
+ DRAM Module
+---------------------------------------------------------------------------------*/
+#define DRAM_SIZE_32M                   0x2000000
+#define DRAM_SIZE_64M                   0x4000000
+#define DRAM_SIZE_128M                  0x8000000
+
+#define DRAM_SIZE                       DRAM_SIZE_128M
+
+#define DRAM_SDRMR                      0x00
+#define SDRMR_DISABLE_DLL               0x80010000
+
+/*------------------------------------------------------------------------------
+ Share Pin Flag
+--------------------------------------------------------------------------------*/
+#ifdef CONFIG_SL2312_SHARE_PIN
+#define FLASH_SHARE_BIT                    0
+#define UART_SHARE_BIT                     1
+#define EMAC_SHARE_BIT                     2
+#define IDE_RW_SHARE_BIT                   3
+#define IDE_CMD_SHARE_BIT                  4
+#endif
+/*-------------------------------------------------------------------------------
+ System Clock
+---------------------------------------------------------------------------------*/
+
+#ifndef SYS_CLK
+#ifdef CONFIG_SL3516_ASIC
+#define SYS_CLK                         150000000
+#else
+#define SYS_CLK                     	20000000
+#endif
+#endif
+
+#define AHB_CLK                     	SYS_CLK
+#define MAX_TIMER                   	3
+#ifndef APB_CLK
+#ifdef CONFIG_SL3516_ASIC
+#define APB_CLK                     	(SYS_CLK / 6)
+#else
+#define APB_CLK				SYS_CLK
+#endif
+#endif
+
+#ifdef CONFIG_SL3516_ASIC
+#define UART_CLK                        48000000	// 30000000 for GeminiA chip, else 48000000
+#else
+#define UART_CLK			48000000
+#endif
+
+#define SL2312_BAUD_115200              (UART_CLK / 1843200)
+#define SL2312_BAUD_57600               (UART_CLK / 921600)
+#define SL2312_BAUD_38400		        (UART_CLK / 614400)
+#define SL2312_BAUD_19200               (UART_CLK / 307200)
+#define SL2312_BAUD_14400               (UART_CLK / 230400)
+#define SL2312_BAUD_9600                (UART_CLK / 153600)
+
+#endif
+
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/sl2312_ipsec.h
@@ -0,0 +1,684 @@
+#ifndef _IPSEC_DIAG_H
+#define _IPSEC_DIAG_H
+
+#include <linux/scatterlist.h>
+
+#define BIG_ENDIAN    0
+
+#define IPSEC_TEST    0
+#define ZERO_COPY     1
+
+#define UINT unsigned int
+#define BYTE unsigned char
+
+/* define cipher algorithm */
+enum CIPHER {
+	DES_ECB_E	=20,
+	TDES_ECB_E	=21,
+	AES_ECB_E	=22,
+	DES_CBC_E	=24,
+	TDES_CBC_E	=25,
+	AES_CBC_E	=26,
+
+	DES_ECB_D	=27,
+	TDES_ECB_D	=28,
+	AES_ECB_D	=29,
+	DES_CBC_D	=31,
+	TDES_CBC_D	=32,
+	AES_CBC_D	=33,
+	A_SHA1      =12,
+	A_HMAC_SHA1 =13,
+	A_MD5       =14,
+	A_HMAC_MD5  =15,
+};
+
+// opMode
+#define CIPHER_ENC    0x1
+#define CIPHER_DEC    0x3
+#define AUTH          0x4
+#define ENC_AUTH      0x5
+#define AUTH_DEC      0x7
+
+// cipherAlgorithm
+#define CBC_DES       0x4
+#define CBC_3DES      0x5
+#define CBC_AES       0x6
+#define ECB_DES       0x0
+#define ECB_3DES      0x1
+#define ECB_AES       0x2
+
+// authAlgorithm
+#define SHA1         0
+#define MD5          1
+#define HMAC_SHA1    2
+#define HMAC_MD5     3
+#define FCS          4
+
+//cipher mode
+#define ECB          0
+#define CBC          1
+
+// authMode
+#define AUTH_APPEND  0
+#define AUTH_CHKVAL  1
+
+/******************************************************/
+/*          the offset of IPSEC DMA register          */
+/******************************************************/
+enum IPSEC_DMA_REGISTER {
+	IPSEC_DMA_DEVICE_ID		= 0xff00,
+	IPSEC_DMA_STATUS		= 0xff04,
+	IPSEC_TXDMA_CTRL 	 	= 0xff08,
+	IPSEC_TXDMA_FIRST_DESC 	= 0xff0c,
+	IPSEC_TXDMA_CURR_DESC	= 0xff10,
+	IPSEC_RXDMA_CTRL		= 0xff14,
+	IPSEC_RXDMA_FIRST_DESC	= 0xff18,
+	IPSEC_RXDMA_CURR_DESC	= 0xff1c,
+	IPSEC_TXDMA_BUF_ADDR    = 0xff28,
+	IPSEC_RXDMA_BUF_ADDR    = 0xff38,
+	IPSEC_RXDMA_BUF_SIZE		= 0xff30,
+};
+
+#define IPSEC_STATUS_REG    0x00a8
+#define IPSEC_RAND_NUM_REG  0x00ac
+
+/******************************************************/
+/* the field definition of IPSEC DMA Module Register  */
+/******************************************************/
+typedef union
+{
+	unsigned int bits32;
+	struct bit2_ff00
+	{
+#if (BIG_ENDIAN==1)
+		unsigned int p_wclk 		:  4;	/* DMA_APB write clock period */
+		unsigned int p_rclk 		:  4;	/* DMA_APB read clock period */
+		unsigned int 				:  8;
+		unsigned int device_id		: 12;
+		unsigned int revision_id	:  4;
+#else
+		unsigned int revision_id	:  4;
+		unsigned int device_id		: 12;
+		unsigned int 				:  8;
+		unsigned int p_rclk 		:  4;	/* DMA_APB read clock period */
+		unsigned int p_wclk	    	:  4;	/* DMA_APB write clock period */
+#endif
+	} bits;
+} IPSEC_DMA_DEVICE_ID_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bit2_ff04
+	{
+#if (BIG_ENDIAN==1)
+		unsigned int ts_finish		:  1;	/* finished tx interrupt */
+		unsigned int ts_derr		:  1;   /* AHB Bus Error while tx */
+		unsigned int ts_perr		:  1;   /* Tx Descriptor protocol error */
+		unsigned int ts_eodi		:  1;	/* TxDMA end of descriptor interrupt */
+		unsigned int ts_eofi		:  1;   /* TxDMA end of frame interrupt */
+		unsigned int rs_finish		:  1;   /* finished rx interrupt */
+		unsigned int rs_derr		:  1;   /* AHB Bus Error while rx */
+		unsigned int rs_perr		:  1;   /* Rx Descriptor protocol error */
+		unsigned int rs_eodi		:  1;	/* RxDMA end of descriptor interrupt */
+		unsigned int rs_eofi		:  1;	/* RxDMA end of frame interrupt */
+        unsigned int intr           :  8;   /* Peripheral interrupt */
+		unsigned int dma_reset 		:  1;	/* write 1 to this bit will cause DMA HClk domain soft reset */
+		unsigned int peri_reset    	:  1;   /* write 1 to this bit will cause DMA PClk domain soft reset */
+		unsigned int 				:  3;
+		unsigned int loop_back		:  1;	/* loopback TxDMA to RxDMA */
+        unsigned int intr_enable    :  8;   /* Peripheral Interrupt Enable */
+#else
+        unsigned int intr_enable    :  8;   /* Peripheral Interrupt Enable */
+		unsigned int loop_back		:  1;	/* loopback TxDMA to RxDMA */
+		unsigned int 				:  3;
+		unsigned int peri_reset    	:  1;   /* write 1 to this bit will cause DMA PClk domain soft reset */
+		unsigned int dma_reset 		:  1;	/* write 1 to this bit will cause DMA HClk domain soft reset */
+        unsigned int intr           :  8;   /* Peripheral interrupt */
+		unsigned int rs_eofi		:  1;	/* RxDMA end of frame interrupt */
+		unsigned int rs_eodi		:  1;	/* RxDMA end of descriptor interrupt */
+		unsigned int rs_perr		:  1;   /* Rx Descriptor protocol error */
+		unsigned int rs_derr		:  1;   /* AHB Bus Error while rx */
+		unsigned int rs_finish		:  1;   /* finished rx interrupt */
+		unsigned int ts_eofi		:  1;   /* TxDMA end of frame interrupt */
+		unsigned int ts_eodi		:  1;	/* TxDMA end of descriptor interrupt */
+		unsigned int ts_perr		:  1;   /* Tx Descriptor protocol error */
+		unsigned int ts_derr		:  1;   /* AHB Bus Error while tx */
+		unsigned int ts_finish		:  1;	/* finished tx interrupt */
+#endif
+	} bits;
+} IPSEC_DMA_STATUS_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bit2_ff08
+	{
+#if (BIG_ENDIAN==1)
+		unsigned int td_start		:  1;	/* Start DMA transfer */
+		unsigned int td_continue	:  1;   /* Continue DMA operation */
+		unsigned int td_chain_mode	:  1;	/* Descriptor Chain Mode;1-Descriptor Chain mode, 0-Direct DMA mode*/
+		unsigned int 				:  1;
+		unsigned int td_prot		:  4;	/* TxDMA protection control */
+		unsigned int td_burst_size  :  2;	/* TxDMA max burst size for every AHB request */
+		unsigned int td_bus		    :  2;	/* peripheral bus width;0 - 8 bits;1 - 16 bits */
+		unsigned int td_endian		:  1;	/* AHB Endian. 0-little endian; 1-big endian */
+		unsigned int td_finish_en   :  1;	/* DMA Finish Event Interrupt Enable;1-enable;0-mask */
+		unsigned int td_fail_en 	:  1;	/* DMA Fail Interrupt Enable;1-enable;0-mask */
+		unsigned int td_perr_en 	:  1;	/* Protocol Failure Interrupt Enable;1-enable;0-mask */
+		unsigned int td_eod_en  	:  1;	/* End of Descriptor interrupt Enable;1-enable;0-mask */
+		unsigned int td_eof_en      :  1;   /* End of frame interrupt Enable;1-enable;0-mask */
+		unsigned int 				: 14;
+#else
+		unsigned int 				: 14;
+		unsigned int td_eof_en      :  1;   /* End of frame interrupt Enable;1-enable;0-mask */
+		unsigned int td_eod_en  	:  1;	/* End of Descriptor interrupt Enable;1-enable;0-mask */
+		unsigned int td_perr_en 	:  1;	/* Protocol Failure Interrupt Enable;1-enable;0-mask */
+		unsigned int td_fail_en 	:  1;	/* DMA Fail Interrupt Enable;1-enable;0-mask */
+		unsigned int td_finish_en   :  1;	/* DMA Finish Event Interrupt Enable;1-enable;0-mask */
+		unsigned int td_endian		:  1;	/* AHB Endian. 0-little endian; 1-big endian */
+		unsigned int td_bus		    :  2;	/* peripheral bus width;0 - 8 bits;1 - 16 bits */
+		unsigned int td_burst_size  :  2;	/* TxDMA max burst size for every AHB request */
+		unsigned int td_prot		:  4;	/* TxDMA protection control */
+		unsigned int 				:  1;
+		unsigned int td_chain_mode	:  1;	/* Descriptor Chain Mode;1-Descriptor Chain mode, 0-Direct DMA mode*/
+		unsigned int td_continue	:  1;   /* Continue DMA operation */
+		unsigned int td_start		:  1;	/* Start DMA transfer */
+#endif
+	} bits;
+} IPSEC_TXDMA_CTRL_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bit2_ff0c
+	{
+#if (BIG_ENDIAN==1)
+		unsigned int td_first_des_ptr	: 28;/* first descriptor address */
+		unsigned int td_busy			:  1;/* 1-TxDMA busy; 0-TxDMA idle */
+		unsigned int 					:  3;
+#else
+		unsigned int 					:  3;
+		unsigned int td_busy			:  1;/* 1-TxDMA busy; 0-TxDMA idle */
+		unsigned int td_first_des_ptr	: 28;/* first descriptor address */
+#endif
+	} bits;
+} IPSEC_TXDMA_FIRST_DESC_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bit2_ff10
+	{
+#if (BIG_ENDIAN==1)
+		unsigned int ndar			: 28;	/* next descriptor address */
+		unsigned int eofie			:  1;	/* end of frame interrupt enable */
+		unsigned int dec			:  1;	/* AHB bus address increment(0)/decrement(1) */
+		unsigned int sof_eof		:  2;
+#else
+		unsigned int sof_eof		:  2;
+		unsigned int dec			:  1;	/* AHB bus address increment(0)/decrement(1) */
+		unsigned int eofie			:  1;	/* end of frame interrupt enable */
+		unsigned int ndar			: 28;	/* next descriptor address */
+#endif
+	} bits;
+} IPSEC_TXDMA_CURR_DESC_T;
+
+
+typedef union
+{
+	unsigned int bits32;
+	struct bit2_ff14
+	{
+#if (BIG_ENDIAN==1)
+		unsigned int rd_start		:  1;	/* Start DMA transfer */
+		unsigned int rd_continue	:  1;   /* Continue DMA operation */
+		unsigned int rd_chain_mode	:  1;	/* Descriptor Chain Mode;1-Descriptor Chain mode, 0-Direct DMA mode*/
+		unsigned int 				:  1;
+		unsigned int rd_prot		:  4;	/* DMA protection control */
+		unsigned int rd_burst_size  :  2;	/* DMA max burst size for every AHB request */
+		unsigned int rd_bus		    :  2;	/* peripheral bus width;0 - 8 bits;1 - 16 bits */
+		unsigned int rd_endian		:  1;	/* AHB Endian. 0-little endian; 1-big endian */
+		unsigned int rd_finish_en   :  1;	/* DMA Finish Event Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_fail_en  	:  1;	/* DMA Fail Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_perr_en 	:  1;	/* Protocol Failure Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_eod_en  	:  1;	/* End of Descriptor interrupt Enable;1-enable;0-mask */
+		unsigned int rd_eof_en      :  1;   /* End of frame interrupt Enable;1-enable;0-mask */
+		unsigned int 				: 14;
+#else
+		unsigned int 				: 14;
+		unsigned int rd_eof_en      :  1;   /* End of frame interrupt Enable;1-enable;0-mask */
+		unsigned int rd_eod_en  	:  1;	/* End of Descriptor interrupt Enable;1-enable;0-mask */
+		unsigned int rd_perr_en 	:  1;	/* Protocol Failure Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_fail_en  	:  1;	/* DMA Fail Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_finish_en   :  1;	/* DMA Finish Event Interrupt Enable;1-enable;0-mask */
+		unsigned int rd_endian		:  1;	/* AHB Endian. 0-little endian; 1-big endian */
+		unsigned int rd_bus		    :  2;	/* peripheral bus width;0 - 8 bits;1 - 16 bits */
+		unsigned int rd_burst_size  :  2;	/* DMA max burst size for every AHB request */
+		unsigned int rd_prot		:  4;	/* DMA protection control */
+		unsigned int 				:  1;
+		unsigned int rd_chain_mode	:  1;	/* Descriptor Chain Mode;1-Descriptor Chain mode, 0-Direct DMA mode*/
+		unsigned int rd_continue	:  1;   /* Continue DMA operation */
+		unsigned int rd_start		:  1;	/* Start DMA transfer */
+#endif
+	} bits;
+} IPSEC_RXDMA_CTRL_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bit2_ff18
+	{
+#if (BIG_ENDIAN==1)
+		unsigned int rd_first_des_ptr	: 28;/* first descriptor address */
+		unsigned int rd_busy			:  1;/* 1-RxDMA busy; 0-RxDMA idle */
+		unsigned int 					:  3;
+#else
+		unsigned int 					:  3;
+		unsigned int rd_busy			:  1;/* 1-RxDMA busy; 0-RxDMA idle */
+		unsigned int rd_first_des_ptr	: 28;/* first descriptor address */
+#endif
+	} bits;
+} IPSEC_RXDMA_FIRST_DESC_T;
+
+typedef union
+{
+	unsigned int bits32;
+	struct bit2_ff1c
+	{
+#if (BIG_ENDIAN==1)
+		unsigned int ndar			: 28;	/* next descriptor address */
+		unsigned int eofie			:  1;	/* end of frame interrupt enable */
+		unsigned int dec			:  1;	/* AHB bus address increment(0)/decrement(1) */
+		unsigned int sof_eof		:  2;
+#else
+		unsigned int sof_eof		:  2;
+		unsigned int dec			:  1;	/* AHB bus address increment(0)/decrement(1) */
+		unsigned int eofie			:  1;	/* end of frame interrupt enable */
+		unsigned int ndar			: 28;	/* next descriptor address */
+#endif
+	} bits;
+} IPSEC_RXDMA_CURR_DESC_T;
+
+
+
+/******************************************************/
+/*    the field definition of IPSEC module Register   */
+/******************************************************/
+typedef union
+{
+	unsigned int id;
+	struct bit_0000
+	{
+#if (BIG_ENDIAN==1)
+		unsigned int device_id		: 28;
+		unsigned int revision_id	:  4;
+#else
+		unsigned int revision_id	:  4;
+		unsigned int device_id		: 28;
+#endif
+	} bits;
+} IPSEC_ID_T;
+
+typedef union
+{
+    unsigned int control;
+    struct bit_0004
+    {
+#if (BIG_ENDIAN==1)
+        unsigned int op_mode            :  4; /* Operation Mode for the IPSec Module */
+        unsigned int                    :  1;
+        unsigned int cipher_algorithm   :  3;
+        unsigned int aesnk              :  4; /* AES Key Size */
+        unsigned int mix_key_sel        :  1; /* 0:use rCipherKey0-3  1:use Key Mixer */
+        unsigned int                    :  2;
+        unsigned int fcs_stream_copy    :  1; /* enable authentication stream copy */
+        unsigned int auth_mode          :  1; /* 0-Append or 1-Check Authentication Result */
+        unsigned int auth_algorithm     :  3;
+        unsigned int                    :  1;
+        unsigned int auth_check_len     :  3; /* Number of 32-bit words to be check or appended */
+                                              /* by the authentication module */
+        unsigned int process_id         :  8; /* Used to identify process.This number will be */
+                                              /* copied to the descriptor status of received packet*/
+#else
+        unsigned int process_id         :  8; /* Used to identify process.This number will be */
+                                              /* copied to the descriptor status of received packet*/
+        unsigned int auth_check_len     :  3; /* Number of 32-bit words to be check or appended */
+                                              /* by the authentication module */
+        unsigned int                    :  1;
+        unsigned int auth_algorithm     :  3;
+        unsigned int auth_mode          :  1; /* 0-Append or 1-Check Authentication Result */
+        unsigned int fcs_stream_copy    :  1; /* enable authentication stream copy */
+        unsigned int                    :  2;
+        unsigned int mix_key_sel        :  1; /* 0:use rCipherKey0-3  1:use Key Mixer */
+        unsigned int aesnk              :  4; /* AES Key Size */
+        unsigned int cipher_algorithm   :  3;
+        unsigned int                    :  1;
+        unsigned int op_mode            :  4; /* Operation Mode for the IPSec Module */
+#endif
+    } bits;
+} IPSEC_CONTROL_T;
+
+
+typedef union
+{
+    unsigned int cipher_packet;
+    struct bit_0008
+    {
+#if (BIG_ENDIAN==1)
+        unsigned int cipher_header_len    : 16; /* The header length to be skipped by the cipher */
+        unsigned int cipher_algorithm_len : 16; /* The length of message body to be encrypted/decrypted */
+#else
+        unsigned int cipher_algorithm_len : 16; /* The length of message body to be encrypted/decrypted */
+        unsigned int cipher_header_len    : 16; /* The header length to be skipped by the cipher */
+#endif
+    } bits;
+} IPSEC_CIPHER_PACKET_T;
+
+typedef union
+{
+    unsigned int auth_packet;
+    struct bit_000c
+    {
+#if (BIG_ENDIAN==1)
+        unsigned int auth_header_len    : 16; /* The header length that is to be skipped by the authenticator */
+        unsigned int auth_algorithm_len : 16; /* The length of message body that is to be authenticated */
+#else
+        unsigned int auth_algorithm_len : 16; /* The length of message body that is to be authenticated */
+        unsigned int auth_header_len    : 16; /* The header length that is to be skipped by the authenticator */
+#endif
+    } bits;
+} IPSEC_AUTH_PACKET_T;
+
+typedef union
+{
+    unsigned int status;
+    struct bit_00a8
+    {
+#if (BIG_ENDIAN==1)
+        unsigned int auth_cmp_rslt  :  1; /* Authentication Compare result */
+        unsigned int wep_crc_ok     :  1; /* WEP ICV compare result */
+        unsigned int tkip_mic_ok    :  1; /* TKIP Mic compare result */
+        unsigned int ccm_mic_ok     :  1; /* CCM Mic compare result */
+        unsigned int                : 16;
+        unsigned int parser_err_code:  4; /* Authentication Compare result */
+        unsigned int auth_err_code  :  4; /* Authentication module error code */
+        unsigned int cipher_err_code:  4; /* Cipher module erroe code */
+#else
+        unsigned int cipher_err_code:  4; /* Cipher module erroe code */
+        unsigned int auth_err_code  :  4; /* Authentication module error code */
+        unsigned int parser_err_code:  4; /* Authentication Compare result */
+        unsigned int                : 16;
+        unsigned int ccm_mic_ok     :  1; /* CCM Mic compare result */
+        unsigned int tkip_mic_ok    :  1; /* TKIP Mic compare result */
+        unsigned int wep_crc_ok     :  1; /* WEP ICV compare result */
+        unsigned int auth_cmp_rslt  :  1; /* Authentication Compare result */
+#endif
+    } bits;
+} IPSEC_STATUS_T;
+
+
+
+/************************************************************************/
+/*              IPSec Descriptor Format                                 */
+/************************************************************************/
+typedef struct descriptor_t
+{
+	union frame_control_t
+	{
+		unsigned int bits32;
+		struct bits_0000
+		{
+#if (BIG_ENDIAN==1)
+			unsigned int own 		: 1;	/* owner bit. 0-CPU, 1-DMA */
+			unsigned int derr		: 1;	/* data error during processing this descriptor */
+			unsigned int perr		: 1;	/* protocol error during processing this descriptor */
+			unsigned int            : 1;    /* authentication compare result */
+			unsigned int            : 6;    /* checksum[15:8] */
+			unsigned int desc_count : 6;	/* number of descriptors used for the current frame */
+			unsigned int buffer_size:16;	/* transfer buffer size associated with current description*/
+#else
+			unsigned int buffer_size:16;	/* transfer buffer size associated with current description*/
+			unsigned int desc_count : 6;	/* number of descriptors used for the current frame */
+			unsigned int            : 6;    /* checksum[15:8] */
+			unsigned int            : 1;    /* authentication compare result */
+			unsigned int perr		: 1;	/* protocol error during processing this descriptor */
+			unsigned int derr		: 1;	/* data error during processing this descriptor */
+			unsigned int own 		: 1;	/* owner bit. 0-CPU, 1-DMA */
+#endif
+		} bits;
+	} frame_ctrl;
+
+	union flag_status_t
+	{
+		unsigned int bits32;
+		struct bits_0004
+		{
+#if (BIG_ENDIAN==1)
+//            unsigned int checksum   : 8; /* checksum[7:0] */
+			unsigned int            : 4;
+			unsigned int auth_result: 1;
+			unsigned int wep_crc_ok : 1;
+			unsigned int tkip_mic_ok: 1;
+			unsigned int ccmp_mic_ok: 1;
+			unsigned int process_id : 8;
+			unsigned int frame_count:16;
+#else
+			unsigned int frame_count:16;
+			unsigned int process_id : 8;
+			unsigned int ccmp_mic_ok: 1;
+			unsigned int tkip_mic_ok: 1;
+			unsigned int wep_crc_ok : 1;
+			unsigned int auth_result: 1;
+			unsigned int            : 4;
+//            unsigned int checksum   : 8; /* checksum[7:0] */
+#endif
+		} bits_rx_status;
+
+		struct bits_0005
+		{
+#if (BIG_ENDIAN==1)
+            unsigned int            : 8;
+			unsigned int process_id : 8;
+			unsigned int frame_count:16;
+#else
+			unsigned int frame_count:16;
+			unsigned int process_id : 8;
+            unsigned int            : 8;
+#endif
+		} bits_tx_status;
+
+		struct bits_0006
+		{
+#if (BIG_ENDIAN==1)
+			unsigned int            :22;
+			unsigned int tqflag     :10;
+#else
+			unsigned int tqflag     :10;
+			unsigned int            :22;
+#endif
+		} bits_tx_flag;
+	} flag_status;
+
+	unsigned int buf_adr;	/* data buffer address */
+
+	union next_desc_t
+	{
+		unsigned int next_descriptor;
+		struct bits_000c
+		{
+#if (BIG_ENDIAN==1)
+			unsigned int ndar		:28;	/* next descriptor address */
+			unsigned int eofie		: 1;	/* end of frame interrupt enable */
+			unsigned int dec   		: 1;	/* AHB bus address. 0-increment; 1-decrement */
+			unsigned int sof_eof	: 2;	/* 00-the linking descriptor   01-the last descriptor of a frame*/
+			                                /* 10-the first descriptor of a frame    11-only one descriptor for a frame*/
+#else
+			unsigned int sof_eof	: 2;	/* 00-the linking descriptor   01-the last descriptor of a frame*/
+			                                /* 10-the first descriptor of a frame    11-only one descriptor for a frame*/
+			unsigned int dec   		: 1;	/* AHB bus address. 0-increment; 1-decrement */
+			unsigned int eofie		: 1;	/* end of frame interrupt enable */
+			unsigned int ndar		:28;	/* next descriptor address */
+#endif
+		} bits;
+	} next_desc;
+} IPSEC_DESCRIPTOR_T;
+
+
+typedef struct IPSEC_S
+{
+    unsigned char       *tx_bufs;
+    unsigned char       *rx_bufs;
+	IPSEC_DESCRIPTOR_T	*tx_desc;	    /* point to virtual TX descriptor address*/
+	IPSEC_DESCRIPTOR_T	*rx_desc;	    /* point to virtual RX descriptor address*/
+	IPSEC_DESCRIPTOR_T	*tx_cur_desc;	/* point to current TX descriptor */
+	IPSEC_DESCRIPTOR_T	*rx_cur_desc;	/* point to current RX descriptor */
+	IPSEC_DESCRIPTOR_T  *tx_finished_desc;
+	IPSEC_DESCRIPTOR_T  *rx_finished_desc;
+	dma_addr_t          rx_desc_dma;	/* physical RX descriptor address */
+	dma_addr_t          tx_desc_dma;    /* physical TX descriptor address */
+	dma_addr_t          rx_bufs_dma;    /* physical RX descriptor address */
+	dma_addr_t          tx_bufs_dma;    /* physical TX descriptor address */
+} IPSEC_T;
+
+
+/*=====================================================================================================*/
+/*  Data Structure of IPSEC Control Packet  */
+/*=====================================================================================================*/
+typedef struct IPSEC_ECB_AUTH_S
+{
+    IPSEC_CONTROL_T         control; /* control parameter */
+    IPSEC_CIPHER_PACKET_T   cipher; /* cipher packet parameter */
+    IPSEC_AUTH_PACKET_T     auth;   /* authentication packet parameter */
+    unsigned char           cipher_key[8*4];
+    unsigned char           auth_check_val[5*4];
+} IPSEC_ECB_AUTH_T;
+
+typedef struct IPSEC_CBC_AUTH_S
+{
+    IPSEC_CONTROL_T         control; /* control parameter */
+    IPSEC_CIPHER_PACKET_T   cipher; /* cipher packet parameter */
+    IPSEC_AUTH_PACKET_T     auth;   /* authentication packet parameter */
+    unsigned char           cipher_iv[4*4];
+    unsigned char           cipher_key[8*4];
+    unsigned char           auth_check_val[5*4];
+} IPSEC_CBC_AUTH_T;
+
+typedef struct IPSEC_ECB_HMAC_AUTH_S
+{
+    IPSEC_CONTROL_T         control; /* control parameter */
+    IPSEC_CIPHER_PACKET_T   cipher; /* cipher packet parameter */
+    IPSEC_AUTH_PACKET_T     auth;   /* authentication packet parameter */
+    unsigned char           cipher_key[8*4];
+    unsigned char           auth_key[16*4];
+    unsigned char           auth_check_val[5*4];
+} IPSEC_ECB_AUTH_HMAC_T;
+
+typedef struct IPSEC_CBC_HMAC_AUTH_S
+{
+    IPSEC_CONTROL_T         control; /* control parameter */
+    IPSEC_CIPHER_PACKET_T   cipher; /* cipher packet parameter */
+    IPSEC_AUTH_PACKET_T     auth;   /* authentication packet parameter */
+    unsigned char           cipher_iv[4*4];
+    unsigned char           cipher_key[8*4];
+    unsigned char           auth_key[16*4];
+    unsigned char           auth_check_val[5*4];
+} IPSEC_CBC_AUTH_HMAC_T;
+
+typedef struct IPSEC_HMAC_AUTH_S
+{
+    IPSEC_CONTROL_T         control; /* control parameter */
+    IPSEC_AUTH_PACKET_T     auth;   /* authentication packet parameter */
+    unsigned char           auth_key[16*4];
+    unsigned char           auth_check_val[5*4];
+} IPSEC_HMAC_AUTH_T;
+
+typedef union
+{
+    unsigned char auth_pkt[28];
+
+    struct IPSEC_AUTH_S
+    {
+        IPSEC_CONTROL_T         control; /* control parameter(4-byte) */
+        IPSEC_AUTH_PACKET_T     auth;   /* authentication packet parameter(4-byte) */
+        unsigned char           auth_check_val[5*4];
+    } var;
+} IPSEC_AUTH_T;
+
+typedef struct IPSEC_CIPHER_CBC_S
+{
+    IPSEC_CONTROL_T         control; /* control parameter */
+    IPSEC_CIPHER_PACKET_T   cipher; /* cipher packet parameter */
+    unsigned char           cipher_iv[4*4];
+    unsigned char           cipher_key[8*4];
+} IPSEC_CIPHER_CBC_T;
+
+typedef struct IPSEC_CIPHER_ECB_S
+{
+    IPSEC_CONTROL_T         control; /* control parameter */
+    IPSEC_CIPHER_PACKET_T   cipher; /* cipher packet parameter */
+    unsigned char           cipher_key[8*4];
+} IPSEC_CIPHER_ECB_T;
+
+
+/****************************************************************************
+ *                          Structure Definition                            *
+ ****************************************************************************/
+struct IPSEC_PACKET_S
+{
+    unsigned int    op_mode;            /* CIPHER_ENC(1),CIPHER_DEC(3),AUTH(4),ENC_AUTH(5),AUTH_DEC(7) */
+    unsigned int    cipher_algorithm;   /* ECB_DES(0),ECB_3DES(1),ECB_AES(2),CBC_DES(4),CBC_3DES(5),CBC_AES(6) */
+    unsigned int    auth_algorithm;     /* SHA1(0),MD5(1),HMAC_SHA1(2),HMAC_MD5(3),FCS(4) */
+    unsigned int    auth_result_mode;   /* AUTH_APPEND(0),AUTH_CHKVAL(1) */
+    unsigned int    process_id;         /* Used to identify the process */
+    unsigned int    auth_header_len;    /* Header length to be skipped by the authenticator */
+    unsigned int    auth_algorithm_len; /* Length of message body that is to be authenticated */
+    unsigned int    cipher_header_len;  /* Header length to be skipped by the cipher */
+    unsigned int    cipher_algorithm_len;   /* Length of message body to be encrypted or decrypted */
+    unsigned char   iv[16];             /* Initial vector used for DES,3DES,AES */
+    unsigned int    iv_size;            /* Initial vector size */
+    unsigned char   auth_key[64];       /* authentication key */
+    unsigned int    auth_key_size;      /* authentication key size */
+    unsigned char   cipher_key[32];     /* cipher key */
+    unsigned int    cipher_key_size;    /* cipher key size */
+    struct scatterlist *in_packet;         /* input_packet buffer pointer */
+    //unsigned char		*in_packet;         /* input_packet buffer pointer */
+    unsigned int    pkt_len;            /* input total packet length */
+    unsigned char   auth_checkval[20];  /* Authentication check value/FCS check value */
+    struct IPSEC_PACKET_S *next,*prev;        /* pointer to next/previous operation to perform on buffer */
+    void (*callback)(struct IPSEC_PACKET_S *); /* function to call when done authentication/cipher */
+    unsigned char   *out_packet;        /* output_packet buffer pointer */
+    //struct scatterlist *out_packet;        /* output_packet buffer pointer */
+    unsigned int    out_pkt_len;        /* output total packet length */
+    unsigned int    auth_cmp_result;    /* authentication compare result */
+    unsigned int    checksum;           /* checksum value */
+    unsigned int    status;             /* ipsec return status. 0:success, others:fail */
+#if (IPSEC_TEST == 1)
+    unsigned char    *sw_packet;         /* for test only */
+    unsigned int    sw_pkt_len;         /* for test only */
+#endif
+} ;
+
+/*****************************************************************************
+ * Function    : ipsec_crypto_hw_process
+ * Description : This function processes H/W authentication and cipher.
+ *       Input : op_info - the authentication and cipher information for IPSec module.
+ *      Output : none.
+ *      Return : 0 - success, others - failure.
+ *****************************************************************************/
+int ipsec_crypto_hw_process(struct IPSEC_PACKET_S  *op_info);
+
+int ipsec_get_cipher_algorithm(unsigned char *alg_name,unsigned int alg_mode);
+int ipsec_get_auth_algorithm(unsigned char *alg_name,unsigned int alg_mode);
+#if 0
+void ipsec_sw_authentication(char *data,unsigned int data_len,char *authkey,char authAlgorithm,char *auth_result);
+void ipsec_sw_cipher(unsigned char *pt,unsigned int pt_len, unsigned char *cipher_key, unsigned int key_size,
+                            unsigned char *iv,unsigned int cipherAlgorithm,unsigned char *ct);
+void ipsec_sw_auth_cipher(unsigned int op_mode,char *data,unsigned int data_len,
+                                BYTE *auth_key,char authAlgorithm,char *auth_result,
+                                char *pt, unsigned int pt_len,char *cipher_key, int key_size,
+                                char *iv, char cipherAlgorithm,char *ct);
+#endif
+
+
+#endif
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/sl_random.h
@@ -0,0 +1,2 @@
+#define RANDOM_ADD		(IO_ADDRESS (0x051000000) + 0x0AC)
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/system.h
@@ -0,0 +1,54 @@
+/*
+ *  linux/include/asm-arm/arch-sl2312/system.h
+ *
+ *  Copyright (C) 1999 ARM Limited
+ *  Copyright (C) 2000 Deep Blue Solutions Ltd
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#ifndef __ASM_ARCH_SYSTEM_H
+#define __ASM_ARCH_SYSTEM_H
+
+#include <asm/arch/platform.h>
+#include <asm/arch/hardware.h>
+#include <asm/arch/it8712.h>
+#include <asm/io.h>
+
+static void arch_idle(void)
+{
+	/*
+	 * This should do all the clock switching
+	 * and wait for interrupt tricks
+	 */
+	cpu_do_idle();
+}
+
+extern __inline__ void arch_reset(char mode)
+{
+	__raw_writel( (int) GLOBAL_RESET|RESET_CPU1, IO_ADDRESS(SL2312_GLOBAL_BASE) + GLOBAL_RESET_REG);
+}
+
+
+void (*pm_power_off)(void);
+//{
+//	printk("arch_power_off\n");
+
+	// Power off
+//	__raw_writel( (int) 0x00000001, IO_ADDRESS(SL2312_POWER_CTRL_BASE) + 0x04);
+
+//}
+
+#endif
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/timer.h
@@ -0,0 +1,53 @@
+/*
+ *
+ *  This file contains the register definitions for the Excalibur
+ *  Timer TIMER00.
+ *
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#ifndef __TIMER_H
+#define __TIMER_H
+
+/*
+ * Register definitions for the timers
+ */
+
+#define TIMER_COUNT(BASE_ADDR)          (TIMER_TYPE (BASE_ADDR  + 0x00 ))
+#define TIMER_LOAD(BASE_ADDR)           (TIMER_TYPE (BASE_ADDR  + 0x04 ))
+#define TIMER_MATCH1(BASE_ADDR)         (TIMER_TYPE (BASE_ADDR  + 0x08 ))
+#define TIMER_MATCH2(BASE_ADDR)         (TIMER_TYPE (BASE_ADDR  + 0x0C ))
+#define TIMER_CR(BASE_ADDR)             (TIMER_TYPE (BASE_ADDR  + 0x30 ))
+#define TIMER_1_CR_ENABLE_MSK 		    (0x00000001)
+#define TIMER_1_CR_ENABLE_OFST 		    (0)
+#define TIMER_1_CR_CLOCK_MSK  		    (0x00000002)
+#define TIMER_1_CR_CLOCK_OFST 		    (1)
+#define TIMER_1_CR_INT_MSK 		        (0x00000004)
+#define TIMER_1_CR_INT_OFST 		    (2)
+#define TIMER_2_CR_ENABLE_MSK 		    (0x00000008)
+#define TIMER_2_CR_ENABLE_OFST 		    (3)
+#define TIMER_2_CR_CLOCK_MSK  		    (0x00000010)
+#define TIMER_2_CR_CLOCK_OFST 		    (4)
+#define TIMER_2_CR_INT_MSK 		        (0x00000020)
+#define TIMER_2_CR_INT_OFST 		    (5)
+#define TIMER_3_CR_ENABLE_MSK 		    (0x00000040)
+#define TIMER_3_CR_ENABLE_OFST 		    (6)
+#define TIMER_3_CR_CLOCK_MSK  		    (0x00000080)
+#define TIMER_3_CR_CLOCK_OFST 		    (7)
+#define TIMER_3_CR_INT_MSK 		        (0x00000100)
+#define TIMER_3_CR_INT_OFST 		    (8)
+
+#endif /* __TIMER00_H */
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/timex.h
@@ -0,0 +1,29 @@
+/*
+ *  linux/include/asm-arm/arch-epxa10db/timex.h
+ *
+ *  Excalibur timex specifications
+ *
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+
+/*
+ * ??
+ */
+#include <asm/arch/sl2312.h>
+
+#define CLOCK_TICK_RATE		APB_CLK
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/uart.h
@@ -0,0 +1,100 @@
+/* *
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#ifndef __UART_H
+#define __UART_H
+
+/*
+ * Register definitions for the UART
+ */
+
+#define UART_TX_FIFO_SIZE      (15)
+
+#define UART_RBR(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x00))  // read
+#define UART_THR(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x00))  // write
+#define UART_IER(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x04))
+#define UART_IER_MS                                 (0x08)
+#define UART_IER_RLS                                (0x04)
+#define UART_IER_TE                                 (0x02)
+#define UART_IER_DR                                 (0x01)
+#define UART_IIR(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x08))   // read
+#define UART_IIR_NONE                		    (0x01)	/* No interrupt pending */
+#define UART_IIR_RLS                 		    (0x06)	/* Receive Line Status */
+#define UART_IIR_DR                  		    (0x04)	/* Receive Data Ready */
+#define UART_IIR_TIMEOUT             		    (0x0c)	/* Receive Time Out */
+#define UART_IIR_TE                  		    (0x02)	/* THR Empty */
+#define UART_IIR_MODEM               		    (0x00)	/* Modem Status */
+#define UART_FCR(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x08))  // write
+#define UART_FCR_FE                  		    (0x01) 	/* FIFO Enable */
+#define UART_FCR_RXFR                		    (0x02) 	/* Rx FIFO Reset */
+#define UART_FCR_TXFR               		    (0x04) 	/* Tx FIFO Reset */
+#define UART_FCR_FIFO_1C                            (0x00)
+#define UART_FCR_FIFO_4C                            (0x40)
+#define UART_FCR_FIFO_8C                            (0x80)
+#define UART_FCR_FIFO_14C                           (0xC0)
+#define UART_LCR(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x0C))
+#define UART_LCR_MSK                                (0x03)
+#define UART_LCR_LEN5                		    (0x00)
+#define UART_LCR_LEN6                		    (0x01)
+#define UART_LCR_LEN7                		    (0x02)
+#define UART_LCR_LEN8                		    (0x03)
+#define UART_LCR_STOP                		    (0x04)
+#define UART_LCR_EVEN                		    (0x18) 	/* Even Parity */
+#define UART_LCR_ODD                 		    (0x08)     	/* Odd Parity */
+#define UART_LCR_PE                  		    (0x08)	/* Parity Enable */
+#define UART_LCR_SETBREAK            		    (0x40)	/* Set Break condition */
+#define UART_LCR_STICKPARITY         		    (0x20)	/* Stick Parity Enable */
+#define UART_LCR_DLAB                		    (0x80)     	/* Divisor Latch Access Bit */
+#define UART_MCR(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x10))
+#define UART_MCR_DTR                 		    (0x1)	/* Data Terminal Ready */
+#define UART_MCR_RTS                 		    (0x2)	/* Request to Send */
+#define UART_MCR_OUT1                		    (0x4)	/* output	1 */
+#define UART_MCR_OUT2                		    (0x8)	/* output2 or global interrupt enable */
+#define UART_MCR_LPBK                		    (0x10)	/* loopback mode */
+#define UART_MCR_MASK                               (0xE3)
+#define UART_LSR(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x14))
+#define UART_LSR_DR                  		    (0x01)     	/* Data Ready */
+#define UART_LSR_OE                  		    (0x02)     	/* Overrun Error */
+#define UART_LSR_PE                  		    (0x04)     	/* Parity Error */
+#define UART_LSR_FE                  		    (0x08)     	/* Framing Error */
+#define UART_LSR_BI                                 (0x10)     	/* Break Interrupt */
+#define UART_LSR_THRE                               (0x20)     	/* THR Empty */
+#define UART_LSR_TE                                 (0x40)     	/* Transmitte Empty */
+#define UART_LSR_DE                                 (0x80)     	/* FIFO Data Error */
+#define UART_MSR(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x18))
+#define UART_MSR_DELTACTS            		    (0x01)	/* Delta CTS */
+#define UART_MSR_DELTADSR            		    (0x02)	/* Delta DSR */
+#define UART_MSR_TERI                		    (0x04)	/* Trailing Edge RI */
+#define UART_MSR_DELTACD             		    (0x08)	/* Delta CD */
+#define UART_MSR_CTS                 		    (0x10)	/* Clear To Send */
+#define UART_MSR_DSR                 		    (0x20)	/* Data Set Ready */
+#define UART_MSR_RI                  		    (0x40)	/* Ring Indicator */
+#define UART_MSR_DCD                 		    (0x80)	/* Data Carrier Detect */
+#define UART_SPR(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x1C))
+#define UART_DIV_LO(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x0))
+#define UART_DIV_HI(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x4))
+#define UART_PSR(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x8))
+#define UART_MDR(BASE_ADDR) (UART_TYPE (BASE_ADDR  + 0x20))
+#define UART_MDR_SERIAL                             (0x0)
+
+#define UART_MSR_DDCD	0x08	/* Delta DCD */
+#define UART_MSR_DDSR	0x02	/* Delta DSR */
+#define UART_MSR_DCTS	0x01	/* Delta CTS */
+#define UART_MSR_ANY_DELTA 0x0F	/* Any of the delta bits! */
+
+
+#endif /* __UART_H */
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/uncompress.h
@@ -0,0 +1,94 @@
+/*
+ *  linux/include/asm-arm/arch-epxa10db/uncompress.h
+ *
+ *  Copyright (C) 1999 ARM Limited
+ *  Copyright (C) 2001 Altera Corporation
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+#include "asm/arch/platform.h"
+#include "asm/arch/hardware.h"
+#define UART_TYPE (volatile unsigned int*)
+#ifndef CONFIG_SERIAL_IT8712
+#include "asm/arch/uart.h"
+#endif
+extern unsigned int it8712_uart_base;
+
+/*
+ * This does not append a newline
+ */
+static void putstr(const char *s)
+{
+
+#ifdef CONFIG_SERIAL_IT8712
+
+	unsigned char *base,*status,stat;
+	int i ;
+
+	status = (unsigned char*)it8712_uart_base + 5;
+	base = (unsigned char*)it8712_uart_base ;
+
+	while (*s) {
+
+		stat = *status;
+		while (!(stat&0x20)) {				// check status
+			for(i=0;i<0x10;i++)	;
+			status = (unsigned char*)it8712_uart_base + 5;
+			stat = *status ;
+		}
+
+		*base = *s;
+		barrier();
+
+		if (*s == '\n') {
+			stat = *status;
+			while (!(stat&0x20)) {			// check status
+				for(i=0;i<0x10;i++)	;
+				status = (unsigned char*)it8712_uart_base + 5;
+				stat = *status ;
+		}
+
+			barrier();
+			*base = '\r';
+		}
+		s++;
+	}
+
+#else
+	while (*s) {
+		while (!(*UART_LSR(SL2312_UART_BASE) &
+		         UART_LSR_THRE));
+		       barrier();
+
+		*UART_THR(SL2312_UART_BASE) = *s;
+
+		if (*s == '\n') {
+			while (!(*UART_LSR(SL2312_UART_BASE) &
+			         UART_LSR_THRE));
+				barrier();
+
+			*UART_THR(SL2312_UART_BASE) = '\r';
+		}
+		s++;
+	}
+#endif
+}
+
+/*
+ * nothing to do
+ */
+#define arch_decomp_setup()
+
+#define arch_decomp_wdog()
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/vmalloc.h
@@ -0,0 +1,36 @@
+/*
+ *  linux/include/asm-arm/arch-epxa10db/vmalloc.h
+ *
+ *  Copyright (C) 2000 Russell King.
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ */
+
+/*
+ * Just any arbitrary offset to the start of the vmalloc VM area: the
+ * current 8MB value just means that there will be a 8MB "hole" after the
+ * physical memory until the kernel virtual memory starts.  That means that
+ * any out-of-bounds memory accesses will hopefully be caught.
+ * The vmalloc() routines leaves a hole of 4kB between each vmalloced
+ * area for the same reason. ;)
+ */
+#define VMALLOC_OFFSET	  (8*1024*1024)
+#define VMALLOC_START	  (((unsigned long)high_memory + VMALLOC_OFFSET) & ~(VMALLOC_OFFSET-1))
+#define VMALLOC_VMADDR(x) ((unsigned long)(x))
+#define VMALLOC_END       (PAGE_OFFSET + 0x10000000)
+
+//#define MODULE_START    (PAGE_OFFSET - 16*1048576)
+//#define MODULE_END      (PAGE_OFFSET)
+
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/watchdog.h
@@ -0,0 +1,58 @@
+#ifndef __WATCHDOG_H
+#define __WATCHDOG_H
+
+#define WATCHDOG_BASE		          (IO_ADDRESS (SL2312_WAQTCHDOG_BASE))
+#define WATCHDOG_COUNTER                  (WATCHDOG_BASE + 0x00)
+#define WATCHDOG_LOAD                     (WATCHDOG_BASE + 0x04)
+#define WATCHDOG_RESTART                  (WATCHDOG_BASE + 0x08)
+#define WATCHDOG_CR                       (WATCHDOG_BASE + 0x0C)
+#define WATCHDOG_STATUS                   (WATCHDOG_BASE + 0x10)
+#define WATCHDOG_CLEAR                    (WATCHDOG_BASE + 0x14)
+#define WATCHDOG_INTRLEN                  (WATCHDOG_BASE + 0x18)
+
+#define WATCHDOG_WDENABLE_MSK 		  (0x00000001)
+#define WATCHDOG_WDENABLE_OFST 		  (0)
+#define WATCHDOG_WDRST_MSK  		  (0x00000002)
+#define WATCHDOG_WDRST_OFST 		  (1)
+#define WATCHDOG_WDINTR_MSK 		  (0x00000004)
+#define WATCHDOG_WDINTR_OFST 		  (2)
+#define WATCHDOG_WDEXT_MSK 		  (0x00000008)
+#define WATCHDOG_WDEXT_OFST 		  (3)
+#define WATCHDOG_WDCLOCK_MSK 		  (0x00000010)
+#define WATCHDOG_WDCLOCK_OFST 		  (4)
+#define WATCHDOG_CR_MASK                  (0x0000001F)
+
+#define WATCHDOG_CLEAR_STATUS             0x1
+#define WATCHDOG_ENABLE                   1
+#define WATCHDOG_DISABLE                  0
+#define WATCHDOG_RESTART_VALUE            0x5AB9
+
+#define WATCHDOG_MINOR	                  130
+
+#define WATCHDOG_IOCTRL_DISABLE	          0x01
+#define WATCHDOG_IOCTRL_SETTIME	          0x02
+#define WATCHDOG_IOCTRL_ENABLE	          0x03
+#define WATCHDOG_IOCTRL_RESTART	          0x04
+
+#define WATCHDOG_TIMEOUT_SCALE            APB_CLK
+#define WATCHDOG_TIMEOUT_MARGIN           30
+#define WATCHDOG_DRIVER_OPEN              1
+#define WATCHDOG_DRIVER_CLOSE             0
+
+
+static void     watchdog_disable(void);
+static void     watchdog_enable(void);
+static int      watchdog_open(struct inode *, struct file *);
+static int      watchdog_release(struct inode *, struct file *);
+static ssize_t  watchdog_read(struct file *, char *, size_t, loff_t *);
+static ssize_t  watchdog_write(struct file *, const char *, size_t, loff_t *);
+static int      watchdog_ioctl(struct inode *, struct file *, unsigned int, unsigned long);
+#ifdef WATCHDOG_TEST
+static void watchdog_fire(int, void *, struct pt_regs *);
+#endif
+
+
+
+
+
+#endif
--- /dev/null
+++ b/include/asm-arm/arch-sl2312/xor.h
@@ -0,0 +1,29 @@
+/*
+ * include/asm-arm/arch-sl2312/xor.h
+ *
+ * Copyright (C) 2005 Storlink Corp.
+ *
+ * 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.
+ */
+
+#ifndef _ASM_ARCH_XOR_H
+#define _ASM_ARCH_XOR_H
+
+/*
+ * Function prototypes
+ */
+void xor_gemini_2(unsigned long bytes, unsigned long *p1, unsigned long *p2);
+
+void xor_gemini_3(unsigned long bytes, unsigned long *p1, unsigned long *p2,
+		             unsigned long *p3);
+
+void xor_gemini_4(unsigned long bytes, unsigned long *p1, unsigned long *p2,
+		             unsigned long *p3, unsigned long *p4);
+
+void xor_gemini_5(unsigned long bytes, unsigned long *p1, unsigned long *p2,
+		             unsigned long *p3, unsigned long *p4, unsigned long *p5);
+
+#endif /* _ASM_ARCH_XOR_H */
+
--- a/include/asm-arm/cacheflush.h
+++ b/include/asm-arm/cacheflush.h
@@ -46,6 +46,18 @@
 # define MULTI_CACHE 1
 #endif
 
+/***********************************************************************
+ *             Storlink SoC -- Cache
+ ***********************************************************************/
+#if defined(CONFIG_CPU_FA526)
+# ifdef _CACHE
+#  define MULTI_CACHE 1
+# else
+#  define _CACHE fa
+# endif
+#endif
+/***********************************************************************/
+
 #if defined(CONFIG_CPU_ARM926T)
 # ifdef _CACHE
 #  define MULTI_CACHE 1
--- a/include/asm-arm/page.h
+++ b/include/asm-arm/page.h
@@ -74,6 +74,18 @@
 # endif
 #endif
 
+/***********************************************************************
+ *             Storlink SoC -- flash
+ ***********************************************************************/
+#ifdef CONFIG_CPU_COPY_FA
+# ifdef _USER
+#  define MULTI_USER 1
+# else
+#  define _USER fa
+# endif
+#endif
+/***********************************************************************/
+
 #ifdef CONFIG_CPU_SA1100
 # ifdef _USER
 #  define MULTI_USER 1
--- a/include/asm-arm/proc-fns.h
+++ b/include/asm-arm/proc-fns.h
@@ -89,6 +89,14 @@
 #   define CPU_NAME cpu_arm922
 #  endif
 # endif
+# ifdef CONFIG_CPU_FA526
+#  ifdef CPU_NAME
+#   undef  MULTI_CPU
+#   define MULTI_CPU
+#  else
+#   define CPU_NAME cpu_fa526
+#  endif
+# endif
 # ifdef CONFIG_CPU_ARM925T
 #  ifdef CPU_NAME
 #   undef  MULTI_CPU
--- a/include/asm-arm/tlbflush.h
+++ b/include/asm-arm/tlbflush.h
@@ -39,6 +39,8 @@
 #define TLB_V6_D_ASID	(1 << 17)
 #define TLB_V6_I_ASID	(1 << 18)
 
+#define TLB_DINVAL      (1 << 28)
+#define TLB_BTB         (1 << 29)
 #define TLB_DCLEAN	(1 << 30)
 #define TLB_WB		(1 << 31)
 
@@ -52,6 +54,7 @@
  *	  v4wb  - ARMv4 with write buffer without I TLB flush entry instruction
  *	  v4wbi - ARMv4 with write buffer with I TLB flush entry instruction
  *	  v6wbi - ARMv6 with write buffer with I TLB flush entry instruction
+ *    fa    - ARMv4 with write buffer with UTLB and branch target buffer (BTB)
  */
 #undef _TLB
 #undef MULTI_TLB
@@ -86,6 +89,44 @@
 # define v4_always_flags	(-1UL)
 #endif
 
+#ifdef CONFIG_CPU_FA_BTB
+#define __TLB_BTB      TLB_BTB
+#else
+#define __TLB_BTB      0
+#endif
+
+#ifdef CONFIG_CPU_FA_WB_DISABLE
+#define __TLB_WB       0
+#else
+#define __TLB_WB       TLB_WB
+#endif
+
+/* Fix buggy CPU which doesn't invalidate Dcache properly */
+#ifdef CONFIG_CPU_FA520
+#define __TLB_DINVAL   TLB_DINVAL
+#elif defined(CONFIG_CPU_FA526)
+//#define __TLB_DINVAL   TLB_DINVAL
+#define __TLB_DINVAL   0
+#else
+#define __TLB_DINVAL   0
+#endif
+
+#define fa_tlb_flags	(__TLB_WB | __TLB_BTB | __TLB_DINVAL | TLB_DCLEAN | \
+                         TLB_V4_U_FULL | TLB_V4_U_PAGE)
+
+#ifdef CONFIG_CPU_TLB_FA
+# define fa_possible_flags	fa_tlb_flags
+# define fa_always_flags	fa_tlb_flags
+# ifdef _TLB
+#  define MULTI_TLB 1
+# else
+#  define _TLB fa
+# endif
+#else
+# define fa_possible_flags	0
+# define fa_always_flags	(-1UL)
+#endif
+
 #define v4wbi_tlb_flags	(TLB_WB | TLB_DCLEAN | \
 			 TLB_V4_I_FULL | TLB_V4_D_FULL | \
 			 TLB_V4_I_PAGE | TLB_V4_D_PAGE)
@@ -246,12 +287,14 @@ extern struct cpu_tlb_fns cpu_tlb;
 				 v4_possible_flags | \
 				 v4wbi_possible_flags | \
 				 v4wb_possible_flags | \
+                 fa_possible_flags | \
 				 v6wbi_possible_flags)
 
 #define always_tlb_flags	(v3_always_flags & \
 				 v4_always_flags & \
 				 v4wbi_always_flags & \
 				 v4wb_always_flags & \
+                 fa_always_flags & \
 				 v6wbi_always_flags)
 
 #define tlb_flag(f)	((always_tlb_flags & (f)) || (__tlb_flag & possible_tlb_flags & (f)))
@@ -261,6 +304,9 @@ static inline void local_flush_tlb_all(v
 	const int zero = 0;
 	const unsigned int __tlb_flag = __cpu_tlb_flags;
 
+	if (tlb_flag(TLB_DINVAL))
+	        asm("mcr%? p15, 0, %0, c7, c14, 0" : : "r" (zero));
+
 	if (tlb_flag(TLB_WB))
 		dsb();
 
@@ -281,6 +327,13 @@ static inline void local_flush_tlb_all(v
 		dsb();
 		isb();
 	}
+
+	if (tlb_flag(TLB_BTB))
+	{
+        asm("mcr%? p15, 0, %0, c7, c5, 6" : : "r" (zero));
+		asm("mov r0, r0" : : );
+		asm("mov r0, r0" : : );
+	}
 }
 
 static inline void local_flush_tlb_mm(struct mm_struct *mm)
@@ -289,6 +342,9 @@ static inline void local_flush_tlb_mm(st
 	const int asid = ASID(mm);
 	const unsigned int __tlb_flag = __cpu_tlb_flags;
 
+	if (tlb_flag(TLB_DINVAL))
+	        asm("mcr%? p15, 0, %0, c7, c14, 0" : : "r" (zero));
+
 	if (tlb_flag(TLB_WB))
 		dsb();
 
@@ -317,6 +373,14 @@ static inline void local_flush_tlb_mm(st
 		asm("mcr p15, 0, %0, c7, c5, 6" : : "r" (zero) : "cc");
 		dsb();
 	}
+
+	if (tlb_flag(TLB_BTB))
+	{
+        asm("mcr%? p15, 0, %0, c7, c5, 6" : : "r" (zero));
+		asm("mov r0, r0" : : );
+		asm("mov r0, r0" : : );
+	}
+
 }
 
 static inline void
@@ -327,6 +391,9 @@ local_flush_tlb_page(struct vm_area_stru
 
 	uaddr = (uaddr & PAGE_MASK) | ASID(vma->vm_mm);
 
+	if (tlb_flag(TLB_DINVAL))
+        asm("mcr%? p15, 0, %0, c7, c14, 0" : : "r" (zero)); // clean & invalidate data cache all
+
 	if (tlb_flag(TLB_WB))
 		dsb();
 
@@ -357,6 +424,13 @@ local_flush_tlb_page(struct vm_area_stru
 		asm("mcr p15, 0, %0, c7, c5, 6" : : "r" (zero) : "cc");
 		dsb();
 	}
+
+	if (tlb_flag(TLB_BTB))
+	{
+        asm("mcr%? p15, 0, %0, c7, c5, 6" : : "r" (zero));
+		asm("mov r0, r0" : : );
+		asm("mov r0, r0" : : );
+	}
 }
 
 static inline void local_flush_tlb_kernel_page(unsigned long kaddr)
@@ -366,6 +440,9 @@ static inline void local_flush_tlb_kerne
 
 	kaddr &= PAGE_MASK;
 
+	if (tlb_flag(TLB_DINVAL))
+        asm("mcr%? p15, 0, %0, c7, c14, 0" : : "r" (zero));
+
 	if (tlb_flag(TLB_WB))
 		dsb();
 
@@ -386,6 +463,12 @@ static inline void local_flush_tlb_kerne
 		asm("mcr p15, 0, %0, c8, c6, 1" : : "r" (kaddr) : "cc");
 	if (tlb_flag(TLB_V6_I_PAGE))
 		asm("mcr p15, 0, %0, c8, c5, 1" : : "r" (kaddr) : "cc");
+	if (tlb_flag(TLB_BTB))
+	{
+        asm("mcr%? p15, 0, %0, c7, c5, 6" : : "r" (zero));
+		asm("mov r0, r0" : : );
+		asm("mov r0, r0" : : );
+	}
 
 	if (tlb_flag(TLB_V6_I_FULL | TLB_V6_D_FULL |
 		     TLB_V6_I_PAGE | TLB_V6_D_PAGE |
@@ -412,6 +495,7 @@ static inline void local_flush_tlb_kerne
  */
 static inline void flush_pmd_entry(pmd_t *pmd)
 {
+	const unsigned int zero = 0;
 	const unsigned int __tlb_flag = __cpu_tlb_flags;
 
 	if (tlb_flag(TLB_DCLEAN))
@@ -419,15 +503,30 @@ static inline void flush_pmd_entry(pmd_t
 			: : "r" (pmd) : "cc");
 	if (tlb_flag(TLB_WB))
 		dsb();
+
+	if (tlb_flag(TLB_BTB)) // Luke Lee 05/16/2005
+	{
+        asm("mcr%? p15, 0, %0, c7, c5, 6" : : "r" (zero));
+		asm("mov r0, r0" : : );
+		asm("mov r0, r0" : : );
+	}
 }
 
 static inline void clean_pmd_entry(pmd_t *pmd)
 {
+    const unsigned int zero = 0; // Luke Lee 05/16/2005 ins 1
 	const unsigned int __tlb_flag = __cpu_tlb_flags;
 
 	if (tlb_flag(TLB_DCLEAN))
 		asm("mcr	p15, 0, %0, c7, c10, 1	@ flush_pmd"
 			: : "r" (pmd) : "cc");
+
+	if (tlb_flag(TLB_BTB)) // Luke Lee 05/16/2005
+	{
+        asm("mcr%? p15, 0, %0, c7, c5, 6" : : "r" (zero));
+		asm("mov r0, r0" : : );
+		asm("mov r0, r0" : : );
+	}
 }
 
 #undef tlb_flag
--- a/include/asm-arm/xor.h
+++ b/include/asm-arm/xor.h
@@ -139,3 +139,18 @@ static struct xor_block_template xor_blo
 		xor_speed(&xor_block_8regs);	\
 		xor_speed(&xor_block_32regs);	\
 	} while (0)
+
+#ifdef CONFIG_GEMINI_XOR_ACCE
+#include <asm/arch/xor.h>
+static struct xor_block_template xor_block_gemini = {
+	.name	= "gemini xor acceleration",
+	.do_2	= xor_gemini_2,
+	.do_3	= xor_gemini_3,
+	.do_4	= xor_gemini_4,
+	.do_5	= xor_gemini_5,};
+#undef XOR_TRY_TEMPLATES
+#define XOR_TRY_TEMPLATES			\
+	do {					\
+	xor_speed(&xor_block_gemini); \
+	} while (0)
+#endif
--- a/include/linux/apm_bios.h
+++ b/include/linux/apm_bios.h
@@ -217,4 +217,24 @@ extern struct apm_info	apm_info;
 #define APM_IOC_STANDBY		_IO('A', 1)
 #define APM_IOC_SUSPEND		_IO('A', 2)
 
+// add by jason for power control
+struct pwc_ioctl_data {
+	unsigned int action;	// sword struct
+	unsigned int data;	// stand shutdown time for PWC_SET_SHUT_TIME
+				// stand shutdown source for PWC_WAIT_BTN
+};
+
+#define POWEROFF		0x01
+#define RESTORE_DEFAULT	0x02
+#define SYSTEM_REBOOT	0x04
+
+#define PWR_SRC_CIR		0x10
+#define PWR_SRC_RTC		0x20
+#define PWR_SRC_BTN		0x40
+
+#define	PWC_IOCTL_BASE			'A'				// use linux APM ioctl
+#define PWC_SET_SHUT_TIME		_IOW('A', 16, struct pwc_ioctl_data)
+#define PWC_WAIT_BTN			_IOR('A', 17, struct pwc_ioctl_data)
+#define PWC_SHUTDOWN			_IO ('A', 18)
+
 #endif	/* LINUX_APM_H */
--- a/kernel/time.c
+++ b/kernel/time.c
@@ -76,6 +76,7 @@ asmlinkage long sys_time(time_t __user *
  * why not move it into the appropriate arch directory (for those
  * architectures that need it).
  */
+extern void rtc_set_time_second(unsigned int second);
  
 asmlinkage long sys_stime(time_t __user *tptr)
 {
@@ -87,6 +88,10 @@ asmlinkage long sys_stime(time_t __user 
 
 	tv.tv_nsec = 0;
 
+#ifdef CONFIG_SL2312_RTC
+    rtc_set_time_second(tv.tv_sec);
+#endif
+
 	err = security_settime(&tv, NULL);
 	if (err)
 		return err;