Merge tag 'v2.6.38' of git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux-2.6

[mv-sheeva.git] / arch / arm / mach-ux500 / cpu.c

diff --git a/arch/arm/mach-ux500/cpu.c b/arch/arm/mach-ux500/cpu.c
index 608a1372b172267170aaab6ecb2e0276fd5d49be..5a43107c62325fc8a3f533053777ca0385cdc436 100644 (file)
--- a/arch/arm/mach-ux500/cpu.c
+++ b/arch/arm/mach-ux500/cpu.c
@@ -6,7 +6,6 @@
  */
 
 #include <linux/platform_device.h>
-#include <linux/amba/bus.h>
 #include <linux/io.h>
 #include <linux/clk.h>
 
@@ -20,54 +19,36 @@
 #include <mach/hardware.h>
 #include <mach/setup.h>
 #include <mach/devices.h>
+#include <mach/prcmu.h>
 
 #include "clock.h"
 
-static struct map_desc ux500_io_desc[] __initdata = {
-       __IO_DEV_DESC(UX500_UART0_BASE, SZ_4K),
-       __IO_DEV_DESC(UX500_UART2_BASE, SZ_4K),
-
-       __IO_DEV_DESC(UX500_GIC_CPU_BASE, SZ_4K),
-       __IO_DEV_DESC(UX500_GIC_DIST_BASE, SZ_4K),
-       __IO_DEV_DESC(UX500_L2CC_BASE, SZ_4K),
-       __IO_DEV_DESC(UX500_TWD_BASE, SZ_4K),
-       __IO_DEV_DESC(UX500_SCU_BASE, SZ_4K),
-
-       __IO_DEV_DESC(UX500_CLKRST1_BASE, SZ_4K),
-       __IO_DEV_DESC(UX500_CLKRST2_BASE, SZ_4K),
-       __IO_DEV_DESC(UX500_CLKRST3_BASE, SZ_4K),
-       __IO_DEV_DESC(UX500_CLKRST5_BASE, SZ_4K),
-       __IO_DEV_DESC(UX500_CLKRST6_BASE, SZ_4K),
-
-       __IO_DEV_DESC(UX500_MTU0_BASE, SZ_4K),
-       __IO_DEV_DESC(UX500_MTU1_BASE, SZ_4K),
-
-       __IO_DEV_DESC(UX500_BACKUPRAM0_BASE, SZ_8K),
-};
-
-static struct amba_device *ux500_amba_devs[] __initdata = {
-       &ux500_pl031_device,
-};
+#ifdef CONFIG_CACHE_L2X0
+static void __iomem *l2x0_base;
+#endif
 
-void __init ux500_map_io(void)
+void __init ux500_init_irq(void)
 {
-       iotable_init(ux500_io_desc, ARRAY_SIZE(ux500_io_desc));
-}
+       void __iomem *dist_base;
+       void __iomem *cpu_base;
 
-void __init ux500_init_devices(void)
-{
-       amba_add_devices(ux500_amba_devs, ARRAY_SIZE(ux500_amba_devs));
-}
+       if (cpu_is_u5500()) {
+               dist_base = __io_address(U5500_GIC_DIST_BASE);
+               cpu_base = __io_address(U5500_GIC_CPU_BASE);
+       } else if (cpu_is_u8500()) {
+               dist_base = __io_address(U8500_GIC_DIST_BASE);
+               cpu_base = __io_address(U8500_GIC_CPU_BASE);
+       } else
+               ux500_unknown_soc();
 
-void __init ux500_init_irq(void)
-{
-       gic_dist_init(0, __io_address(UX500_GIC_DIST_BASE), 29);
-       gic_cpu_init(0, __io_address(UX500_GIC_CPU_BASE));
+       gic_init(0, 29, dist_base, cpu_base);
 
        /*
         * Init clocks here so that they are available for system timer
         * initialization.
         */
+       if (cpu_is_u8500())
+               prcmu_early_init();
        clk_init();
 }
 
@@ -81,7 +62,8 @@ static inline void ux500_cache_wait(void __iomem *reg, unsigned long mask)
 
 static inline void ux500_cache_sync(void)
 {
-       void __iomem *base = __io_address(UX500_L2CC_BASE);
+       void __iomem *base = l2x0_base;
+
        writel_relaxed(0, base + L2X0_CACHE_SYNC);
        ux500_cache_wait(base + L2X0_CACHE_SYNC, 1);
 }
@@ -103,20 +85,23 @@ static void ux500_l2x0_disable(void)
  */
 static void ux500_l2x0_inv_all(void)
 {
-       void __iomem *l2x0_base = __io_address(UX500_L2CC_BASE);
+       void __iomem *base = l2x0_base;
        uint32_t l2x0_way_mask = (1<<16) - 1;   /* Bitmask of active ways */
 
        /* invalidate all ways */
-       writel_relaxed(l2x0_way_mask, l2x0_base + L2X0_INV_WAY);
-       ux500_cache_wait(l2x0_base + L2X0_INV_WAY, l2x0_way_mask);
+       writel_relaxed(l2x0_way_mask, base + L2X0_INV_WAY);
+       ux500_cache_wait(base + L2X0_INV_WAY, l2x0_way_mask);
        ux500_cache_sync();
 }
 
 static int ux500_l2x0_init(void)
 {
-       void __iomem *l2x0_base;
-
-       l2x0_base = __io_address(UX500_L2CC_BASE);
+       if (cpu_is_u5500())
+               l2x0_base = __io_address(U5500_L2CC_BASE);
+       else if (cpu_is_u8500())
+               l2x0_base = __io_address(U8500_L2CC_BASE);
+       else
+               ux500_unknown_soc();
 
        /* 64KB way size, 8 way associativity, force WA */
        l2x0_init(l2x0_base, 0x3e060000, 0xc0000fff);
@@ -134,13 +119,21 @@ static void __init ux500_timer_init(void)
 {
 #ifdef CONFIG_LOCAL_TIMERS
        /* Setup the local timer base */
-       twd_base = __io_address(UX500_TWD_BASE);
+       if (cpu_is_u5500())
+               twd_base = __io_address(U5500_TWD_BASE);
+       else if (cpu_is_u8500())
+               twd_base = __io_address(U8500_TWD_BASE);
+       else
+               ux500_unknown_soc();
 #endif
-       /* Setup the MTU base */
-       if (cpu_is_u8500ed())
+       if (cpu_is_u5500())
+               mtu_base = __io_address(U5500_MTU0_BASE);
+       else if (cpu_is_u8500ed())
                mtu_base = __io_address(U8500_MTU0_BASE_ED);
+       else if (cpu_is_u8500())
+               mtu_base = __io_address(U8500_MTU0_BASE);
        else
-               mtu_base = __io_address(UX500_MTU0_BASE);
+               ux500_unknown_soc();
 
        nmdk_timer_init();
 }