1 files changed, 181 insertions, 0 deletions

diff --git a/firmware/target/arm/olympus/mrobe-500/system-mr500.c b/firmware/target/arm/olympus/mrobe-500/system-mr500.c
new file mode 100644
index 0000000000..c93c9f6260
--- /dev/null
+++ b/firmware/target/arm/olympus/mrobe-500/system-mr500.c
@@ -0,0 +1,181 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id: $
+ *
+ * Copyright (C) 2007 by Karl Kurbjun
+ *
+ * All files in this archive are subject to the GNU General Public License.
+ * See the file COPYING in the source tree root for full license agreement.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+ 
+#include "kernel.h"
+#include "system.h"
+#include "panic.h"
+
+#define default_interrupt(name) \
+  extern __attribute__((weak,alias("UIRQ"))) void name (void)
+
+default_interrupt(TIMER0);
+default_interrupt(TIMER1);
+default_interrupt(TIMER2);
+default_interrupt(TIMER3);
+default_interrupt(CCD_VD0);
+default_interrupt(CCD_VD1);
+default_interrupt(CCD_WEN);
+default_interrupt(VENC);
+default_interrupt(SERIAL0);
+default_interrupt(SERIAL1);
+default_interrupt(EXT_HOST);
+default_interrupt(DSPHINT);
+default_interrupt(UART0);
+default_interrupt(UART1);
+default_interrupt(USB_DMA);
+default_interrupt(USB_CORE);
+default_interrupt(VLYNQ);
+default_interrupt(MTC0);
+default_interrupt(MTC1);
+default_interrupt(SD_MMC);
+default_interrupt(SDIO_MS);
+default_interrupt(GIO0);
+default_interrupt(GIO1);
+default_interrupt(GIO2);
+default_interrupt(GIO3);
+default_interrupt(GIO4);
+default_interrupt(GIO5);
+default_interrupt(GIO6);
+default_interrupt(GIO7);
+default_interrupt(GIO8);
+default_interrupt(GIO9);
+default_interrupt(GIO10);
+default_interrupt(GIO11);
+default_interrupt(GIO12);
+default_interrupt(GIO13);
+default_interrupt(GIO14);
+default_interrupt(GIO15);
+default_interrupt(PREVIEW0);
+default_interrupt(PREVIEW1);
+default_interrupt(WATCHDOG);
+default_interrupt(I2C);
+default_interrupt(CLKC);
+default_interrupt(ICE);
+default_interrupt(ARMCOM_RX);
+default_interrupt(ARMCOM_TX);
+default_interrupt(RESERVED);
+
+static void (* const irqvector[])(void) =
+{
+    TIMER0,TIMER1,TIMER2,TIMER3,CCD_VD0,CCD_VD1,
+    CCD_WEN,VENC,SERIAL0,SERIAL1,EXT_HOST,DSPHINT,
+    UART0,UART1,USB_DMA,USB_CORE,VLYNQ,MTC0,MTC1,
+    SD_MMC,SDIO_MS,GIO0,GIO1,GIO2,GIO3,GIO4,GIO5,
+    GIO6,GIO7,GIO8,GIO9,GIO10,GIO11,GIO12,GIO13,
+    GIO14,GIO15,PREVIEW0,PREVIEW1,WATCHDOG,I2C,CLKC,
+    ICE,ARMCOM_RX,ARMCOM_TX,RESERVED
+};
+
+static const char * const irqname[] =
+{
+    "TIMER0","TIMER1","TIMER2","TIMER3","CCD_VD0","CCD_VD1",
+    "CCD_WEN","VENC","SERIAL0","SERIAL1","EXT_HOST","DSPHINT",
+    "UART0","UART1","USB_DMA","USB_CORE","VLYNQ","MTC0","MTC1",
+    "SD_MMC","SDIO_MS","GIO0","GIO1","GIO2","GIO3","GIO4","GIO5",
+    "GIO6","GIO7","GIO8","GIO9","GIO10","GIO11","GIO12","GIO13",
+    "GIO14","GIO15","PREVIEW0","PREVIEW1","WATCHDOG","I2C","CLKC",
+    "ICE","ARMCOM_RX","ARMCOM_TX","RESERVED"
+};
+
+static void UIRQ(void)
+{
+    unsigned int offset = inw(IO_INTC_IRQENTRY0);
+    panicf("Unhandled IRQ %02X: %s", offset, irqname[offset]);
+}
+
+void irq_handler(void) __attribute__((interrupt ("IRQ"), naked));
+void irq_handler(void)
+{
+    /*
+     * Based on: linux/arch/arm/kernel/entry-armv.S and system-meg-fx.c
+     */
+
+    asm volatile (
+        "sub    lr, lr, #4            \r\n"
+        "stmfd  sp!, {r0-r3, ip, lr}  \r\n"
+        "mov    r0, #0x00030000       \r\n"
+        "ldr    r0, [r0, #0x518]       \r\n"
+        "ldr    r1, =irqvector        \r\n"
+        "ldr    r1, [r1, r0, lsl #2]  \r\n"
+        "mov    lr, pc                \r\n"
+        "bx     r1                    \r\n"
+        "ldmfd  sp!, {r0-r3, ip, pc}^ \r\n"
+    );
+}
+
+void system_reboot(void)
+{
+
+}
+
+void system_init(void)
+{
+    /* taken from linux/arch/arm/mach-itdm320-20/irq.c */
+
+        /* Clearing all FIQs and IRQs. */
+        outw(0xFFFF, IO_INTC_IRQ0);
+        outw(0xFFFF, IO_INTC_IRQ1);
+        outw(0xFFFF, IO_INTC_IRQ2);
+
+        outw(0xFFFF, IO_INTC_FIQ0);
+        outw(0xFFFF, IO_INTC_FIQ1);
+        outw(0xFFFF, IO_INTC_FIQ2);
+
+        /* Masking all Interrupts. */
+        outw(0, IO_INTC_EINT0);
+        outw(0, IO_INTC_EINT1);
+        outw(0, IO_INTC_EINT2);
+
+        /* Setting INTC to all IRQs. */
+        outw(0, IO_INTC_FISEL0);
+        outw(0, IO_INTC_FISEL1);
+        outw(0, IO_INTC_FISEL2);
+}
+
+int system_memory_guard(int newmode)
+{
+    (void)newmode;
+    return 0;
+}
+
+#ifdef HAVE_ADJUSTABLE_CPU_FREQ
+
+void set_cpu_frequency(long frequency)
+{
+    if (frequency == CPUFREQ_MAX)
+    {
+        asm volatile("mov r0, #0\n"
+            "mrc p15, 0, r0, c1, c0, 0\n"
+            "orr r0, r0, #3<<30\n" /* set to Asynchronous mode*/
+            "mcr p15, 0, r0, c1, c0, 0" : : : "r0");
+
+        FREQ = CPUFREQ_MAX;
+    }
+    else
+    {
+        asm volatile("mov r0, #0\n"
+            "mrc p15, 0, r0, c1, c0, 0\n"
+            "bic r0, r0, #3<<30\n" /* set to FastBus mode*/
+            "mcr p15, 0, r0, c1, c0, 0" : : : "r0");
+
+        FREQ = CPUFREQ_NORMAL;
+    }
+}
+
+#endif