1
0
mirror of git://projects.qi-hardware.com/openwrt-xburst.git synced 2024-11-05 12:48:25 +02:00
openwrt-xburst/target/linux/storm/patches/001-arch.patch
juhosg 32e68db8d0 [storm] refresh patches
git-svn-id: svn://svn.openwrt.org/openwrt/trunk@14449 3c298f89-4303-0410-b956-a3cf2f4a3e73
2009-02-08 19:14:06 +00:00

8865 lines
277 KiB
Diff

--- 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;