Move PortalPlayer system.c code into the target tree.

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@13239 a1c6a512-1295-4272-9138-f99709370657

4 files changed, 448 insertions, 386 deletions

diff --git a/firmware/SOURCES b/firmware/SOURCES
index 90ec640476..53e3c03c97 100644
--- a/firmware/SOURCES
+++ b/firmware/SOURCES
@@ -282,6 +282,11 @@ target/arm/pnx0101/i2c-pnx0101.c
 target/arm/pnx0101/system-pnx0101.c
 #endif
 #if defined(CPU_PP)
+#if CONFIG_CPU == PP5002
+target/arm/system-pp5002.c
+#elif (CONFIG_CPU == PP5020) || (CONFIG_CPU == PP5024)
+target/arm/system-pp502x.c
+#endif
 #ifdef BOOTLOADER
 target/arm/crt0-pp-bl.S
 #else
diff --git a/firmware/system.c b/firmware/system.c
index e4b11e8b79..badeb30e84 100644
--- a/firmware/system.c
+++ b/firmware/system.c
@@ -201,391 +201,5 @@ void UIE(unsigned int pc, unsigned int num)
     }
 }
 
-#if CONFIG_CPU==PP5020 || CONFIG_CPU==PP5024
-
-unsigned int ipod_hw_rev;
-
-#ifndef BOOTLOADER
-extern void TIMER1(void);
-extern void TIMER2(void);
-
-#if defined(IPOD_MINI) /* mini 1 only, mini 2G uses iPod 4G code */
-extern void ipod_mini_button_int(void);
-
-void irq(void)
-{
-    if(CURRENT_CORE == CPU)
-    {
-        if (CPU_INT_STAT & TIMER1_MASK)
-            TIMER1();
-        else if (CPU_INT_STAT & TIMER2_MASK)
-            TIMER2();
-        else if (CPU_HI_INT_STAT & GPIO_MASK)
-            ipod_mini_button_int();
-    } else {
-        if (COP_INT_STAT & TIMER1_MASK)
-            TIMER1();
-        else if (COP_INT_STAT & TIMER2_MASK)
-            TIMER2();
-        else if (COP_HI_INT_STAT & GPIO_MASK)
-            ipod_mini_button_int();
-    }
-}
-#elif (defined IRIVER_H10) || (defined IRIVER_H10_5GB) || defined(ELIO_TPJ1022) \
-    || (defined SANSA_E200)
-/* TODO: this should really be in the target tree, but moving it there caused
-   crt0.S not to find it while linking */
-/* TODO: Even if it isn't in the target tree, this should be the default case */
-void irq(void)
-{
-    if(CURRENT_CORE == CPU)
-    {
-        if (CPU_INT_STAT & TIMER1_MASK)
-            TIMER1();
-        else if (CPU_INT_STAT & TIMER2_MASK)
-            TIMER2();
-    } else {
-        if (COP_INT_STAT & TIMER1_MASK)
-            TIMER1();
-        else if (COP_INT_STAT & TIMER2_MASK)
-            TIMER2();
-    }
-}
-#else
-extern void ipod_4g_button_int(void);
-
-void irq(void)
-{
-    if(CURRENT_CORE == CPU)
-    {
-        if (CPU_INT_STAT & TIMER1_MASK)
-            TIMER1();
-        else if (CPU_INT_STAT & TIMER2_MASK)
-            TIMER2();
-        else if (CPU_HI_INT_STAT & I2C_MASK)
-            ipod_4g_button_int();
-    } else {
-        if (COP_INT_STAT & TIMER1_MASK)
-            TIMER1();
-        else if (COP_INT_STAT & TIMER2_MASK)
-            TIMER2();
-        else if (COP_HI_INT_STAT & I2C_MASK)
-            ipod_4g_button_int();
-    }
-}
-#endif
-#endif /* BOOTLOADER */
-
-/* TODO: The following two function have been lifted straight from IPL, and
-   hence have a lot of numeric addresses used straight. I'd like to use
-   #defines for these, but don't know what most of them are for or even what
-   they should be named. Because of this I also have no way of knowing how
-   to extend the funtions to do alternate cache configurations and/or
-   some other CPU frequency scaling. */
-
-#ifndef BOOTLOADER
-static void ipod_init_cache(void)
-{
-/* Initialising the cache in the iPod bootloader prevents Rockbox from starting */
-    unsigned i;
-
-    /* cache init mode? */
-    CACHE_CTL = CACHE_INIT;
-
-    /* PP5002 has 8KB cache */
-    for (i = 0xf0004000; i < 0xf0006000; i += 16) {
-        outl(0x0, i);
-    }
-
-    outl(0x0, 0xf000f040);
-    outl(0x3fc0, 0xf000f044);
-
-    /* enable cache */
-    CACHE_CTL = CACHE_ENABLE;
-
-    for (i = 0x10000000; i < 0x10002000; i += 16)
-        inb(i);
-}
-#endif
-
-/* Not all iPod targets support CPU freq. boosting yet */
-#ifdef HAVE_ADJUSTABLE_CPU_FREQ
-void set_cpu_frequency(long frequency)
-{
-    unsigned long postmult;
-
-# if NUM_CORES > 1
-    /* Using mutex or spinlock isn't safe here. */
-    while (test_and_set(&boostctrl_mtx.locked, 1)) ;
-# endif
-    
-    if (frequency == CPUFREQ_NORMAL)
-        postmult = CPUFREQ_NORMAL_MULT;
-    else if (frequency == CPUFREQ_MAX)
-        postmult = CPUFREQ_MAX_MULT;
-    else
-        postmult = CPUFREQ_DEFAULT_MULT;
-    cpu_frequency = frequency;
-
-    /* Enable PLL? */
-    outl(inl(0x70000020) | (1<<30), 0x70000020);
-    
-    /* Select 24MHz crystal as clock source? */
-    outl((inl(0x60006020) & 0x0fffff0f) | 0x20000020, 0x60006020);
-    
-    /* Clock frequency = (24/8)*postmult */
-    outl(0xaa020000 | 8 | (postmult << 8), 0x60006034);
-    
-    /* Wait for PLL relock? */
-    udelay(2000);
-    
-    /* Select PLL as clock source? */
-    outl((inl(0x60006020) & 0x0fffff0f) | 0x20000070, 0x60006020);
-    
-# if defined(IPOD_COLOR) || defined(IPOD_4G) || defined(IPOD_MINI) || defined(IRIVER_H10) || defined(IRIVER_H10_5GB)
-    /* We don't know why the timer interrupt gets disabled on the PP5020
-     based ipods, but without the following line, the 4Gs will freeze
-     when CPU frequency changing is enabled.
-
-     Note also that a simple "CPU_INT_EN = TIMER1_MASK;" (as used
-     elsewhere to enable interrupts) doesn't work, we need "|=".
-
-     It's not needed on the PP5021 and PP5022 ipods.
-     */
-
-    /* unmask interrupt source */
-    CPU_INT_EN |= TIMER1_MASK;
-    COP_INT_EN |= TIMER1_MASK;
-# endif
-    
-# if NUM_CORES > 1
-    boostctrl_mtx.locked = 0;
-# endif
-}
-#elif !defined(BOOTLOADER)
-void ipod_set_cpu_frequency(void)
-{
-    /* Enable PLL? */
-    outl(inl(0x70000020) | (1<<30), 0x70000020);
-
-    /* Select 24MHz crystal as clock source? */
-    outl((inl(0x60006020) & 0x0fffff0f) | 0x20000020, 0x60006020);
-
-    /* Clock frequency = (24/8)*25 = 75MHz */
-    outl(0xaa020000 | 8 | (25 << 8), 0x60006034);
-    /* Wait for PLL relock? */
-    udelay(2000);
-
-    /* Select PLL as clock source? */
-    outl((inl(0x60006020) & 0x0fffff0f) | 0x20000070, 0x60006020);
-}
-#endif
-
-void system_init(void)
-{
-#ifndef BOOTLOADER
-    if (CURRENT_CORE == CPU)
-    {
-        /* Remap the flash ROM from 0x00000000 to 0x20000000. */
-        MMAP3_LOGICAL  = 0x20000000 | 0x3a00;
-        MMAP3_PHYSICAL = 0x00000000 | 0x3f84;
-
-        /* The hw revision is written to the last 4 bytes of SDRAM by the
-           bootloader - we save it before Rockbox overwrites it. */
-        ipod_hw_rev = (*((volatile unsigned long*)(0x01fffffc)));
-
-        /* disable all irqs */
-        COP_HI_INT_CLR      = -1;
-        CPU_HI_INT_CLR      = -1;
-        HI_INT_FORCED_CLR   = -1;
-        
-        COP_INT_CLR         = -1;
-        CPU_INT_CLR         = -1;
-        INT_FORCED_CLR      = -1;
-        
-# if NUM_CORES > 1 && defined(HAVE_ADJUSTABLE_CPU_FREQ)
-        spinlock_init(&boostctrl_mtx);
-# endif
-        
-#if (!defined HAVE_ADJUSTABLE_CPU_FREQ) && (NUM_CORES == 1)
-        ipod_set_cpu_frequency();
-#endif
-    }
-#if (!defined HAVE_ADJUSTABLE_CPU_FREQ) && (NUM_CORES > 1)
-    else
-    {
-        ipod_set_cpu_frequency();
-    }
-#endif
-    ipod_init_cache();
-#endif
-}
-
-void system_reboot(void)
-{
-    /* Reboot */
-    DEV_RS |= DEV_SYSTEM;
-}
-
-int system_memory_guard(int newmode)
-{
-    (void)newmode;
-    return 0;
-}
-#elif CONFIG_CPU==PP5002
-unsigned int ipod_hw_rev;
-#ifndef BOOTLOADER
-extern void TIMER1(void);
-extern void TIMER2(void);
-
-void irq(void)
-{
-    if(CURRENT_CORE == CPU)
-    {
-        if (CPU_INT_STAT & TIMER1_MASK)
-            TIMER1();
-        else if (CPU_INT_STAT & TIMER2_MASK)
-            TIMER2();
-    } else {
-        if (COP_INT_STAT & TIMER1_MASK)
-            TIMER1();
-        else if (COP_INT_STAT & TIMER2_MASK)
-            TIMER2();
-    }
-}
-
-#endif
-
-unsigned int current_core(void)
-{
-    if(((*(volatile unsigned long *)(0xc4000000)) & 0xff) == 0x55)
-    {
-        return CPU;
-    }
-    return COP;
-}
-
-
-/* TODO: The following two function have been lifted straight from IPL, and
-   hence have a lot of numeric addresses used straight. I'd like to use
-   #defines for these, but don't know what most of them are for or even what
-   they should be named. Because of this I also have no way of knowing how
-   to extend the funtions to do alternate cache configurations and/or
-   some other CPU frequency scaling. */
-
-#ifndef BOOTLOADER
-static void ipod_init_cache(void)
-{
-    int i =0;
-/* Initialising the cache in the iPod bootloader prevents Rockbox from starting */
-    outl(inl(0xcf004050) & ~0x700, 0xcf004050);
-    outl(0x4000, 0xcf004020);
-
-    outl(0x2, 0xcf004024);
-
-    /* PP5002 has 8KB cache */
-    for (i = 0xf0004000; i < (int)(0xf0006000); i += 16) {
-        outl(0x0, i);
-    }
-
-    outl(0x0, 0xf000f020);
-    outl(0x3fc0, 0xf000f024);
-
-    outl(0x3, 0xcf004024);
-}
-    
-#endif
-
-#ifdef HAVE_ADJUSTABLE_CPU_FREQ
-void set_cpu_frequency(long frequency)
-{
-    unsigned long postmult;
-
-    if (CURRENT_CORE == CPU)
-    {
-        if (frequency == CPUFREQ_NORMAL)
-            postmult = CPUFREQ_NORMAL_MULT;
-        else if (frequency == CPUFREQ_MAX)
-            postmult = CPUFREQ_MAX_MULT;
-        else
-            postmult = CPUFREQ_DEFAULT_MULT;
-        cpu_frequency = frequency;
-
-        outl(0x02, 0xcf005008);
-        outl(0x55, 0xcf00500c);
-        outl(0x6000, 0xcf005010);
-
-        /* Clock frequency = (24/8)*postmult */
-        outl(8, 0xcf005018);
-        outl(postmult, 0xcf00501c);
-
-        outl(0xe000, 0xcf005010);
-
-        /* Wait for PLL relock? */
-        udelay(2000);
-
-        /* Select PLL as clock source? */
-        outl(0xa8, 0xcf00500c);
-    }
-}
-#elif !defined(BOOTLOADER)
-static void ipod_set_cpu_speed(void)
-{
-    outl(0x02, 0xcf005008);
-    outl(0x55, 0xcf00500c);
-    outl(0x6000, 0xcf005010);
-#if 1
-    // 75  MHz (24/24 * 75) (default)
-    outl(24, 0xcf005018);
-    outl(75, 0xcf00501c);
-#endif
-
-#if 0
-    // 66 MHz (24/3 * 8)
-    outl(3, 0xcf005018);
-    outl(8, 0xcf00501c);
-#endif
-
-    outl(0xe000, 0xcf005010);
-
-    udelay(2000);
-
-    outl(0xa8, 0xcf00500c);
-}
-#endif
-
-void system_init(void)
-{
-#ifndef BOOTLOADER
-    if (CURRENT_CORE == CPU)
-    {
-        /* Remap the flash ROM from 0x00000000 to 0x20000000. */
-        MMAP3_LOGICAL  = 0x20000000 | 0x3a00;
-        MMAP3_PHYSICAL = 0x00000000 | 0x3f84;
-
-        ipod_hw_rev = (*((volatile unsigned long*)(0x01fffffc)));
-        outl(-1, 0xcf00101c);
-        outl(-1, 0xcf001028);
-        outl(-1, 0xcf001038);
-#ifndef HAVE_ADJUSTABLE_CPU_FREQ
-        ipod_set_cpu_speed();
-#endif
-    }
-    ipod_init_cache();
-#endif
-}
-
-void system_reboot(void)
-{
-    outl(inl(0xcf005030) | 0x4, 0xcf005030);
-}
-
-int system_memory_guard(int newmode)
-{
-    (void)newmode;
-    return 0;
-}
-
 #endif /* CPU_ARM */
-#endif /* CONFIG_CPU */
 
diff --git a/firmware/target/arm/system-pp5002.c b/firmware/target/arm/system-pp5002.c
new file mode 100644
index 0000000000..4954d0660a
--- /dev/null
+++ b/firmware/target/arm/system-pp5002.c
@@ -0,0 +1,184 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2002 by Alan Korr
+ *
+ * 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 <stdio.h>
+#include "config.h"
+#include <stdbool.h>
+#include "lcd.h"
+#include "font.h"
+#include "system.h"
+#include "kernel.h"
+#include "thread.h"
+#include "timer.h"
+#include "inttypes.h"
+#include "string.h"
+
+unsigned int ipod_hw_rev;
+#ifndef BOOTLOADER
+extern void TIMER1(void);
+extern void TIMER2(void);
+
+void irq(void)
+{
+    if(CURRENT_CORE == CPU)
+    {
+        if (CPU_INT_STAT & TIMER1_MASK)
+            TIMER1();
+        else if (CPU_INT_STAT & TIMER2_MASK)
+            TIMER2();
+    } else {
+        if (COP_INT_STAT & TIMER1_MASK)
+            TIMER1();
+        else if (COP_INT_STAT & TIMER2_MASK)
+            TIMER2();
+    }
+}
+
+#endif
+
+unsigned int current_core(void)
+{
+    if(((*(volatile unsigned long *)(0xc4000000)) & 0xff) == 0x55)
+    {
+        return CPU;
+    }
+    return COP;
+}
+
+
+/* TODO: The following two function have been lifted straight from IPL, and
+   hence have a lot of numeric addresses used straight. I'd like to use
+   #defines for these, but don't know what most of them are for or even what
+   they should be named. Because of this I also have no way of knowing how
+   to extend the funtions to do alternate cache configurations and/or
+   some other CPU frequency scaling. */
+
+#ifndef BOOTLOADER
+static void ipod_init_cache(void)
+{
+    int i =0;
+/* Initialising the cache in the iPod bootloader prevents Rockbox from starting */
+    outl(inl(0xcf004050) & ~0x700, 0xcf004050);
+    outl(0x4000, 0xcf004020);
+
+    outl(0x2, 0xcf004024);
+
+    /* PP5002 has 8KB cache */
+    for (i = 0xf0004000; i < (int)(0xf0006000); i += 16) {
+        outl(0x0, i);
+    }
+
+    outl(0x0, 0xf000f020);
+    outl(0x3fc0, 0xf000f024);
+
+    outl(0x3, 0xcf004024);
+}
+    
+#endif
+
+#ifdef HAVE_ADJUSTABLE_CPU_FREQ
+void set_cpu_frequency(long frequency)
+{
+    unsigned long postmult;
+
+    if (CURRENT_CORE == CPU)
+    {
+        if (frequency == CPUFREQ_NORMAL)
+            postmult = CPUFREQ_NORMAL_MULT;
+        else if (frequency == CPUFREQ_MAX)
+            postmult = CPUFREQ_MAX_MULT;
+        else
+            postmult = CPUFREQ_DEFAULT_MULT;
+        cpu_frequency = frequency;
+
+        outl(0x02, 0xcf005008);
+        outl(0x55, 0xcf00500c);
+        outl(0x6000, 0xcf005010);
+
+        /* Clock frequency = (24/8)*postmult */
+        outl(8, 0xcf005018);
+        outl(postmult, 0xcf00501c);
+
+        outl(0xe000, 0xcf005010);
+
+        /* Wait for PLL relock? */
+        udelay(2000);
+
+        /* Select PLL as clock source? */
+        outl(0xa8, 0xcf00500c);
+    }
+}
+#elif !defined(BOOTLOADER)
+static void ipod_set_cpu_speed(void)
+{
+    outl(0x02, 0xcf005008);
+    outl(0x55, 0xcf00500c);
+    outl(0x6000, 0xcf005010);
+#if 1
+    // 75  MHz (24/24 * 75) (default)
+    outl(24, 0xcf005018);
+    outl(75, 0xcf00501c);
+#endif
+
+#if 0
+    // 66 MHz (24/3 * 8)
+    outl(3, 0xcf005018);
+    outl(8, 0xcf00501c);
+#endif
+
+    outl(0xe000, 0xcf005010);
+
+    udelay(2000);
+
+    outl(0xa8, 0xcf00500c);
+}
+#endif
+
+void system_init(void)
+{
+#ifndef BOOTLOADER
+    if (CURRENT_CORE == CPU)
+    {
+        /* Remap the flash ROM from 0x00000000 to 0x20000000. */
+        MMAP3_LOGICAL  = 0x20000000 | 0x3a00;
+        MMAP3_PHYSICAL = 0x00000000 | 0x3f84;
+
+        ipod_hw_rev = (*((volatile unsigned long*)(0x01fffffc)));
+        outl(-1, 0xcf00101c);
+        outl(-1, 0xcf001028);
+        outl(-1, 0xcf001038);
+#ifndef HAVE_ADJUSTABLE_CPU_FREQ
+        ipod_set_cpu_speed();
+#endif
+    }
+    ipod_init_cache();
+#endif
+}
+
+void system_reboot(void)
+{
+    outl(inl(0xcf005030) | 0x4, 0xcf005030);
+}
+
+int system_memory_guard(int newmode)
+{
+    (void)newmode;
+    return 0;
+}
+
+
diff --git a/firmware/target/arm/system-pp502x.c b/firmware/target/arm/system-pp502x.c
new file mode 100644
index 0000000000..afffcd9283
--- /dev/null
+++ b/firmware/target/arm/system-pp502x.c
@@ -0,0 +1,259 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2002 by Alan Korr
+ *
+ * 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 <stdio.h>
+#include "config.h"
+#include <stdbool.h>
+#include "lcd.h"
+#include "font.h"
+#include "system.h"
+#include "kernel.h"
+#include "thread.h"
+#include "timer.h"
+#include "inttypes.h"
+#include "string.h"
+
+unsigned int ipod_hw_rev;
+
+#ifndef BOOTLOADER
+extern void TIMER1(void);
+extern void TIMER2(void);
+
+#if defined(IPOD_MINI) /* mini 1 only, mini 2G uses iPod 4G code */
+extern void ipod_mini_button_int(void);
+
+void irq(void)
+{
+    if(CURRENT_CORE == CPU)
+    {
+        if (CPU_INT_STAT & TIMER1_MASK)
+            TIMER1();
+        else if (CPU_INT_STAT & TIMER2_MASK)
+            TIMER2();
+        else if (CPU_HI_INT_STAT & GPIO_MASK)
+            ipod_mini_button_int();
+    } else {
+        if (COP_INT_STAT & TIMER1_MASK)
+            TIMER1();
+        else if (COP_INT_STAT & TIMER2_MASK)
+            TIMER2();
+        else if (COP_HI_INT_STAT & GPIO_MASK)
+            ipod_mini_button_int();
+    }
+}
+#elif (defined IRIVER_H10) || (defined IRIVER_H10_5GB) || defined(ELIO_TPJ1022) \
+    || (defined SANSA_E200)
+/* TODO: this should really be in the target tree, but moving it there caused
+   crt0.S not to find it while linking */
+/* TODO: Even if it isn't in the target tree, this should be the default case */
+void irq(void)
+{
+    if(CURRENT_CORE == CPU)
+    {
+        if (CPU_INT_STAT & TIMER1_MASK)
+            TIMER1();
+        else if (CPU_INT_STAT & TIMER2_MASK)
+            TIMER2();
+    } else {
+        if (COP_INT_STAT & TIMER1_MASK)
+            TIMER1();
+        else if (COP_INT_STAT & TIMER2_MASK)
+            TIMER2();
+    }
+}
+#else
+extern void ipod_4g_button_int(void);
+
+void irq(void)
+{
+    if(CURRENT_CORE == CPU)
+    {
+        if (CPU_INT_STAT & TIMER1_MASK)
+            TIMER1();
+        else if (CPU_INT_STAT & TIMER2_MASK)
+            TIMER2();
+        else if (CPU_HI_INT_STAT & I2C_MASK)
+            ipod_4g_button_int();
+    } else {
+        if (COP_INT_STAT & TIMER1_MASK)
+            TIMER1();
+        else if (COP_INT_STAT & TIMER2_MASK)
+            TIMER2();
+        else if (COP_HI_INT_STAT & I2C_MASK)
+            ipod_4g_button_int();
+    }
+}
+#endif
+#endif /* BOOTLOADER */
+
+/* TODO: The following two function have been lifted straight from IPL, and
+   hence have a lot of numeric addresses used straight. I'd like to use
+   #defines for these, but don't know what most of them are for or even what
+   they should be named. Because of this I also have no way of knowing how
+   to extend the funtions to do alternate cache configurations and/or
+   some other CPU frequency scaling. */
+
+#ifndef BOOTLOADER
+static void ipod_init_cache(void)
+{
+/* Initialising the cache in the iPod bootloader prevents Rockbox from starting */
+    unsigned i;
+
+    /* cache init mode? */
+    CACHE_CTL = CACHE_INIT;
+
+    /* PP5002 has 8KB cache */
+    for (i = 0xf0004000; i < 0xf0006000; i += 16) {
+        outl(0x0, i);
+    }
+
+    outl(0x0, 0xf000f040);
+    outl(0x3fc0, 0xf000f044);
+
+    /* enable cache */
+    CACHE_CTL = CACHE_ENABLE;
+
+    for (i = 0x10000000; i < 0x10002000; i += 16)
+        inb(i);
+}
+#endif
+
+/* Not all iPod targets support CPU freq. boosting yet */
+#ifdef HAVE_ADJUSTABLE_CPU_FREQ
+void set_cpu_frequency(long frequency)
+{
+    unsigned long postmult;
+
+# if NUM_CORES > 1
+    /* Using mutex or spinlock isn't safe here. */
+    while (test_and_set(&boostctrl_mtx.locked, 1)) ;
+# endif
+    
+    if (frequency == CPUFREQ_NORMAL)
+        postmult = CPUFREQ_NORMAL_MULT;
+    else if (frequency == CPUFREQ_MAX)
+        postmult = CPUFREQ_MAX_MULT;
+    else
+        postmult = CPUFREQ_DEFAULT_MULT;
+    cpu_frequency = frequency;
+
+    /* Enable PLL? */
+    outl(inl(0x70000020) | (1<<30), 0x70000020);
+    
+    /* Select 24MHz crystal as clock source? */
+    outl((inl(0x60006020) & 0x0fffff0f) | 0x20000020, 0x60006020);
+    
+    /* Clock frequency = (24/8)*postmult */
+    outl(0xaa020000 | 8 | (postmult << 8), 0x60006034);
+    
+    /* Wait for PLL relock? */
+    udelay(2000);
+    
+    /* Select PLL as clock source? */
+    outl((inl(0x60006020) & 0x0fffff0f) | 0x20000070, 0x60006020);
+    
+# if defined(IPOD_COLOR) || defined(IPOD_4G) || defined(IPOD_MINI) || defined(IRIVER_H10) || defined(IRIVER_H10_5GB)
+    /* We don't know why the timer interrupt gets disabled on the PP5020
+     based ipods, but without the following line, the 4Gs will freeze
+     when CPU frequency changing is enabled.
+
+     Note also that a simple "CPU_INT_EN = TIMER1_MASK;" (as used
+     elsewhere to enable interrupts) doesn't work, we need "|=".
+
+     It's not needed on the PP5021 and PP5022 ipods.
+     */
+
+    /* unmask interrupt source */
+    CPU_INT_EN |= TIMER1_MASK;
+    COP_INT_EN |= TIMER1_MASK;
+# endif
+    
+# if NUM_CORES > 1
+    boostctrl_mtx.locked = 0;
+# endif
+}
+#elif !defined(BOOTLOADER)
+void ipod_set_cpu_frequency(void)
+{
+    /* Enable PLL? */
+    outl(inl(0x70000020) | (1<<30), 0x70000020);
+
+    /* Select 24MHz crystal as clock source? */
+    outl((inl(0x60006020) & 0x0fffff0f) | 0x20000020, 0x60006020);
+
+    /* Clock frequency = (24/8)*25 = 75MHz */
+    outl(0xaa020000 | 8 | (25 << 8), 0x60006034);
+    /* Wait for PLL relock? */
+    udelay(2000);
+
+    /* Select PLL as clock source? */
+    outl((inl(0x60006020) & 0x0fffff0f) | 0x20000070, 0x60006020);
+}
+#endif
+
+void system_init(void)
+{
+#ifndef BOOTLOADER
+    if (CURRENT_CORE == CPU)
+    {
+        /* Remap the flash ROM from 0x00000000 to 0x20000000. */
+        MMAP3_LOGICAL  = 0x20000000 | 0x3a00;
+        MMAP3_PHYSICAL = 0x00000000 | 0x3f84;
+
+        /* The hw revision is written to the last 4 bytes of SDRAM by the
+           bootloader - we save it before Rockbox overwrites it. */
+        ipod_hw_rev = (*((volatile unsigned long*)(0x01fffffc)));
+
+        /* disable all irqs */
+        COP_HI_INT_CLR      = -1;
+        CPU_HI_INT_CLR      = -1;
+        HI_INT_FORCED_CLR   = -1;
+        
+        COP_INT_CLR         = -1;
+        CPU_INT_CLR         = -1;
+        INT_FORCED_CLR      = -1;
+        
+# if NUM_CORES > 1 && defined(HAVE_ADJUSTABLE_CPU_FREQ)
+        spinlock_init(&boostctrl_mtx);
+# endif
+        
+#if (!defined HAVE_ADJUSTABLE_CPU_FREQ) && (NUM_CORES == 1)
+        ipod_set_cpu_frequency();
+#endif
+    }
+#if (!defined HAVE_ADJUSTABLE_CPU_FREQ) && (NUM_CORES > 1)
+    else
+    {
+        ipod_set_cpu_frequency();
+    }
+#endif
+    ipod_init_cache();
+#endif
+}
+
+void system_reboot(void)
+{
+    /* Reboot */
+    DEV_RS |= DEV_SYSTEM;
+}
+
+int system_memory_guard(int newmode)
+{
+    (void)newmode;
+    return 0;
+}