diff options
author | Russell King <rmk+kernel@arm.linux.org.uk> | 2009-11-10 18:37:21 -0500 |
---|---|---|
committer | Russell King <rmk+kernel@arm.linux.org.uk> | 2009-11-10 18:37:21 -0500 |
commit | 65f69e5c16f8eee17b7f71bfad9e8e58f44c7386 (patch) | |
tree | 0bfc3b13f311387b9fc12db2cb44fea3713d2708 /arch/arm | |
parent | cc20d42986d5807cbe4f5c7c8e3dab2e59ea0db3 (diff) | |
parent | c97c5aa83c41a532bc67da356d77da929bc41b9c (diff) |
Merge branch 'for-rmk' of git://linux-arm.org/linux-2.6
Diffstat (limited to 'arch/arm')
-rw-r--r-- | arch/arm/kernel/smp_scu.c | 4 | ||||
-rw-r--r-- | arch/arm/mach-realview/Kconfig | 5 | ||||
-rw-r--r-- | arch/arm/mach-realview/core.c | 42 | ||||
-rw-r--r-- | arch/arm/mach-realview/core.h | 6 | ||||
-rw-r--r-- | arch/arm/mach-realview/include/mach/memory.h | 49 | ||||
-rw-r--r-- | arch/arm/mach-realview/platsmp.c | 5 | ||||
-rw-r--r-- | arch/arm/mach-realview/realview_eb.c | 1 | ||||
-rw-r--r-- | arch/arm/mach-realview/realview_pb1176.c | 13 | ||||
-rw-r--r-- | arch/arm/mach-realview/realview_pb11mp.c | 1 | ||||
-rw-r--r-- | arch/arm/mach-realview/realview_pba8.c | 1 | ||||
-rw-r--r-- | arch/arm/mach-realview/realview_pbx.c | 21 | ||||
-rw-r--r-- | arch/arm/mm/proc-v7.S | 7 |
12 files changed, 146 insertions, 9 deletions
diff --git a/arch/arm/kernel/smp_scu.c b/arch/arm/kernel/smp_scu.c index d3831f616ee9..9ab4149bd983 100644 --- a/arch/arm/kernel/smp_scu.c +++ b/arch/arm/kernel/smp_scu.c | |||
@@ -37,6 +37,10 @@ void __init scu_enable(void __iomem *scu_base) | |||
37 | u32 scu_ctrl; | 37 | u32 scu_ctrl; |
38 | 38 | ||
39 | scu_ctrl = __raw_readl(scu_base + SCU_CTRL); | 39 | scu_ctrl = __raw_readl(scu_base + SCU_CTRL); |
40 | /* already enabled? */ | ||
41 | if (scu_ctrl & 1) | ||
42 | return; | ||
43 | |||
40 | scu_ctrl |= 1; | 44 | scu_ctrl |= 1; |
41 | __raw_writel(scu_ctrl, scu_base + SCU_CTRL); | 45 | __raw_writel(scu_ctrl, scu_base + SCU_CTRL); |
42 | 46 | ||
diff --git a/arch/arm/mach-realview/Kconfig b/arch/arm/mach-realview/Kconfig index dfc9b0bc6eb2..c48e1f2c3349 100644 --- a/arch/arm/mach-realview/Kconfig +++ b/arch/arm/mach-realview/Kconfig | |||
@@ -70,6 +70,8 @@ config MACH_REALVIEW_PBX | |||
70 | bool "Support RealView/PBX platform" | 70 | bool "Support RealView/PBX platform" |
71 | select ARM_GIC | 71 | select ARM_GIC |
72 | select HAVE_PATA_PLATFORM | 72 | select HAVE_PATA_PLATFORM |
73 | select ARCH_SPARSEMEM_ENABLE if CPU_V7 && !HIGH_PHYS_OFFSET | ||
74 | select ZONE_DMA if SPARSEMEM | ||
73 | help | 75 | help |
74 | Include support for the ARM(R) RealView PBX platform. | 76 | Include support for the ARM(R) RealView PBX platform. |
75 | 77 | ||
@@ -82,6 +84,7 @@ config REALVIEW_HIGH_PHYS_OFFSET | |||
82 | 0x70000000, 256MB of which being mirrored at 0x00000000. If | 84 | 0x70000000, 256MB of which being mirrored at 0x00000000. If |
83 | the board supports 512MB of RAM, this option allows the | 85 | the board supports 512MB of RAM, this option allows the |
84 | memory to be accessed contiguously at the high physical | 86 | memory to be accessed contiguously at the high physical |
85 | offset. | 87 | offset. On the PBX board, disabling this option allows 1GB of |
88 | RAM to be used with SPARSEMEM. | ||
86 | 89 | ||
87 | endmenu | 90 | endmenu |
diff --git a/arch/arm/mach-realview/core.c b/arch/arm/mach-realview/core.c index a2083b60e3fb..9f293438e020 100644 --- a/arch/arm/mach-realview/core.c +++ b/arch/arm/mach-realview/core.c | |||
@@ -59,6 +59,25 @@ | |||
59 | /* used by entry-macro.S and platsmp.c */ | 59 | /* used by entry-macro.S and platsmp.c */ |
60 | void __iomem *gic_cpu_base_addr; | 60 | void __iomem *gic_cpu_base_addr; |
61 | 61 | ||
62 | #ifdef CONFIG_ZONE_DMA | ||
63 | /* | ||
64 | * Adjust the zones if there are restrictions for DMA access. | ||
65 | */ | ||
66 | void __init realview_adjust_zones(int node, unsigned long *size, | ||
67 | unsigned long *hole) | ||
68 | { | ||
69 | unsigned long dma_size = SZ_256M >> PAGE_SHIFT; | ||
70 | |||
71 | if (!machine_is_realview_pbx() || node || (size[0] <= dma_size)) | ||
72 | return; | ||
73 | |||
74 | size[ZONE_NORMAL] = size[0] - dma_size; | ||
75 | size[ZONE_DMA] = dma_size; | ||
76 | hole[ZONE_NORMAL] = hole[0]; | ||
77 | hole[ZONE_DMA] = 0; | ||
78 | } | ||
79 | #endif | ||
80 | |||
62 | /* | 81 | /* |
63 | * This is the RealView sched_clock implementation. This has | 82 | * This is the RealView sched_clock implementation. This has |
64 | * a resolution of 41.7ns, and a maximum value of about 179s. | 83 | * a resolution of 41.7ns, and a maximum value of about 179s. |
@@ -543,7 +562,7 @@ static int realview_clcd_setup(struct clcd_fb *fb) | |||
543 | fb->panel = realview_clcd_panel(); | 562 | fb->panel = realview_clcd_panel(); |
544 | 563 | ||
545 | fb->fb.screen_base = dma_alloc_writecombine(&fb->dev->dev, framesize, | 564 | fb->fb.screen_base = dma_alloc_writecombine(&fb->dev->dev, framesize, |
546 | &dma, GFP_KERNEL); | 565 | &dma, GFP_KERNEL | GFP_DMA); |
547 | if (!fb->fb.screen_base) { | 566 | if (!fb->fb.screen_base) { |
548 | printk(KERN_ERR "CLCD: unable to map framebuffer\n"); | 567 | printk(KERN_ERR "CLCD: unable to map framebuffer\n"); |
549 | return -ENOMEM; | 568 | return -ENOMEM; |
@@ -788,3 +807,24 @@ void __init realview_timer_init(unsigned int timer_irq) | |||
788 | realview_clocksource_init(); | 807 | realview_clocksource_init(); |
789 | realview_clockevents_init(timer_irq); | 808 | realview_clockevents_init(timer_irq); |
790 | } | 809 | } |
810 | |||
811 | /* | ||
812 | * Setup the memory banks. | ||
813 | */ | ||
814 | void realview_fixup(struct machine_desc *mdesc, struct tag *tags, char **from, | ||
815 | struct meminfo *meminfo) | ||
816 | { | ||
817 | /* | ||
818 | * Most RealView platforms have 512MB contiguous RAM at 0x70000000. | ||
819 | * Half of this is mirrored at 0. | ||
820 | */ | ||
821 | #ifdef CONFIG_REALVIEW_HIGH_PHYS_OFFSET | ||
822 | meminfo->bank[0].start = 0x70000000; | ||
823 | meminfo->bank[0].size = SZ_512M; | ||
824 | meminfo->nr_banks = 1; | ||
825 | #else | ||
826 | meminfo->bank[0].start = 0; | ||
827 | meminfo->bank[0].size = SZ_256M; | ||
828 | meminfo->nr_banks = 1; | ||
829 | #endif | ||
830 | } | ||
diff --git a/arch/arm/mach-realview/core.h b/arch/arm/mach-realview/core.h index 699671fa6e0b..781bca68a9fa 100644 --- a/arch/arm/mach-realview/core.h +++ b/arch/arm/mach-realview/core.h | |||
@@ -25,6 +25,7 @@ | |||
25 | #include <linux/amba/bus.h> | 25 | #include <linux/amba/bus.h> |
26 | #include <linux/io.h> | 26 | #include <linux/io.h> |
27 | 27 | ||
28 | #include <asm/setup.h> | ||
28 | #include <asm/leds.h> | 29 | #include <asm/leds.h> |
29 | 30 | ||
30 | #define AMBA_DEVICE(name,busid,base,plat) \ | 31 | #define AMBA_DEVICE(name,busid,base,plat) \ |
@@ -44,6 +45,8 @@ static struct amba_device name##_device = { \ | |||
44 | /* .dma = base##_DMA,*/ \ | 45 | /* .dma = base##_DMA,*/ \ |
45 | } | 46 | } |
46 | 47 | ||
48 | struct machine_desc; | ||
49 | |||
47 | extern struct platform_device realview_flash_device; | 50 | extern struct platform_device realview_flash_device; |
48 | extern struct platform_device realview_cf_device; | 51 | extern struct platform_device realview_cf_device; |
49 | extern struct platform_device realview_i2c_device; | 52 | extern struct platform_device realview_i2c_device; |
@@ -61,5 +64,8 @@ extern void realview_timer_init(unsigned int timer_irq); | |||
61 | extern int realview_flash_register(struct resource *res, u32 num); | 64 | extern int realview_flash_register(struct resource *res, u32 num); |
62 | extern int realview_eth_register(const char *name, struct resource *res); | 65 | extern int realview_eth_register(const char *name, struct resource *res); |
63 | extern int realview_usb_register(struct resource *res); | 66 | extern int realview_usb_register(struct resource *res); |
67 | extern void realview_fixup(struct machine_desc *mdesc, struct tag *tags, | ||
68 | char **from, struct meminfo *meminfo); | ||
64 | extern void (*realview_reset)(char); | 69 | extern void (*realview_reset)(char); |
70 | |||
65 | #endif | 71 | #endif |
diff --git a/arch/arm/mach-realview/include/mach/memory.h b/arch/arm/mach-realview/include/mach/memory.h index 293c30025e7e..2417bbcf97fd 100644 --- a/arch/arm/mach-realview/include/mach/memory.h +++ b/arch/arm/mach-realview/include/mach/memory.h | |||
@@ -29,4 +29,53 @@ | |||
29 | #define PHYS_OFFSET UL(0x00000000) | 29 | #define PHYS_OFFSET UL(0x00000000) |
30 | #endif | 30 | #endif |
31 | 31 | ||
32 | #if !defined(__ASSEMBLY__) && defined(CONFIG_ZONE_DMA) | ||
33 | extern void realview_adjust_zones(int node, unsigned long *size, | ||
34 | unsigned long *hole); | ||
35 | #define arch_adjust_zones(node, size, hole) \ | ||
36 | realview_adjust_zones(node, size, hole) | ||
37 | |||
38 | #define ISA_DMA_THRESHOLD (PHYS_OFFSET + SZ_256M - 1) | ||
39 | #define MAX_DMA_ADDRESS (PAGE_OFFSET + SZ_256M) | ||
40 | #endif | ||
41 | |||
42 | #ifdef CONFIG_SPARSEMEM | ||
43 | |||
44 | /* | ||
45 | * Sparsemem definitions for RealView PBX. | ||
46 | * | ||
47 | * The RealView PBX board has another block of 512MB of RAM at 0x20000000, | ||
48 | * however only the block at 0x70000000 (or the 256MB mirror at 0x00000000) | ||
49 | * may be used for DMA. | ||
50 | * | ||
51 | * The macros below define a section size of 256MB and a non-linear virtual to | ||
52 | * physical mapping: | ||
53 | * | ||
54 | * 256MB @ 0x00000000 -> PAGE_OFFSET | ||
55 | * 512MB @ 0x20000000 -> PAGE_OFFSET + 0x10000000 | ||
56 | * 256MB @ 0x80000000 -> PAGE_OFFSET + 0x30000000 | ||
57 | */ | ||
58 | #ifdef CONFIG_REALVIEW_HIGH_PHYS_OFFSET | ||
59 | #error "SPARSEMEM not available with REALVIEW_HIGH_PHYS_OFFSET" | ||
60 | #endif | ||
61 | |||
62 | #define MAX_PHYSMEM_BITS 32 | ||
63 | #define SECTION_SIZE_BITS 28 | ||
64 | |||
65 | /* bank page offsets */ | ||
66 | #define PAGE_OFFSET1 (PAGE_OFFSET + 0x10000000) | ||
67 | #define PAGE_OFFSET2 (PAGE_OFFSET + 0x30000000) | ||
68 | |||
69 | #define __phys_to_virt(phys) \ | ||
70 | ((phys) >= 0x80000000 ? (phys) - 0x80000000 + PAGE_OFFSET2 : \ | ||
71 | (phys) >= 0x20000000 ? (phys) - 0x20000000 + PAGE_OFFSET1 : \ | ||
72 | (phys) + PAGE_OFFSET) | ||
73 | |||
74 | #define __virt_to_phys(virt) \ | ||
75 | ((virt) >= PAGE_OFFSET2 ? (virt) - PAGE_OFFSET2 + 0x80000000 : \ | ||
76 | (virt) >= PAGE_OFFSET1 ? (virt) - PAGE_OFFSET1 + 0x20000000 : \ | ||
77 | (virt) - PAGE_OFFSET) | ||
78 | |||
79 | #endif /* CONFIG_SPARSEMEM */ | ||
80 | |||
32 | #endif | 81 | #endif |
diff --git a/arch/arm/mach-realview/platsmp.c b/arch/arm/mach-realview/platsmp.c index a88458b4799d..009265818d55 100644 --- a/arch/arm/mach-realview/platsmp.c +++ b/arch/arm/mach-realview/platsmp.c | |||
@@ -146,11 +146,8 @@ static void __init poke_milo(void) | |||
146 | * register. The BootMonitor waits for this register to become | 146 | * register. The BootMonitor waits for this register to become |
147 | * non-zero. | 147 | * non-zero. |
148 | */ | 148 | */ |
149 | #define REALVIEW_SYS_FLAGSS_OFFSET 0x30 | ||
150 | #define REALVIEW_SYS_FLAGSC_OFFSET 0x34 | ||
151 | __raw_writel(BSYM(virt_to_phys(realview_secondary_startup)), | 149 | __raw_writel(BSYM(virt_to_phys(realview_secondary_startup)), |
152 | __io_address(REALVIEW_SYS_BASE) + | 150 | __io_address(REALVIEW_SYS_FLAGSSET)); |
153 | REALVIEW_SYS_FLAGSS_OFFSET); | ||
154 | 151 | ||
155 | mb(); | 152 | mb(); |
156 | } | 153 | } |
diff --git a/arch/arm/mach-realview/realview_eb.c b/arch/arm/mach-realview/realview_eb.c index 1d65e64ae571..917f8ca3abff 100644 --- a/arch/arm/mach-realview/realview_eb.c +++ b/arch/arm/mach-realview/realview_eb.c | |||
@@ -415,6 +415,7 @@ MACHINE_START(REALVIEW_EB, "ARM-RealView EB") | |||
415 | .phys_io = REALVIEW_EB_UART0_BASE, | 415 | .phys_io = REALVIEW_EB_UART0_BASE, |
416 | .io_pg_offst = (IO_ADDRESS(REALVIEW_EB_UART0_BASE) >> 18) & 0xfffc, | 416 | .io_pg_offst = (IO_ADDRESS(REALVIEW_EB_UART0_BASE) >> 18) & 0xfffc, |
417 | .boot_params = PHYS_OFFSET + 0x00000100, | 417 | .boot_params = PHYS_OFFSET + 0x00000100, |
418 | .fixup = realview_fixup, | ||
418 | .map_io = realview_eb_map_io, | 419 | .map_io = realview_eb_map_io, |
419 | .init_irq = gic_init_irq, | 420 | .init_irq = gic_init_irq, |
420 | .timer = &realview_eb_timer, | 421 | .timer = &realview_eb_timer, |
diff --git a/arch/arm/mach-realview/realview_pb1176.c b/arch/arm/mach-realview/realview_pb1176.c index a6ba147692c1..7fb726d5f8b9 100644 --- a/arch/arm/mach-realview/realview_pb1176.c +++ b/arch/arm/mach-realview/realview_pb1176.c | |||
@@ -300,6 +300,18 @@ static void realview_pb1176_reset(char mode) | |||
300 | __raw_writel(REALVIEW_PB1176_SYS_LOCKVAL_RSTCTL, hdr_ctrl); | 300 | __raw_writel(REALVIEW_PB1176_SYS_LOCKVAL_RSTCTL, hdr_ctrl); |
301 | } | 301 | } |
302 | 302 | ||
303 | static void realview_pb1176_fixup(struct machine_desc *mdesc, | ||
304 | struct tag *tags, char **from, | ||
305 | struct meminfo *meminfo) | ||
306 | { | ||
307 | /* | ||
308 | * RealView PB1176 only has 128MB of RAM mapped at 0. | ||
309 | */ | ||
310 | meminfo->bank[0].start = 0; | ||
311 | meminfo->bank[0].size = SZ_128M; | ||
312 | meminfo->nr_banks = 1; | ||
313 | } | ||
314 | |||
303 | static void __init realview_pb1176_init(void) | 315 | static void __init realview_pb1176_init(void) |
304 | { | 316 | { |
305 | int i; | 317 | int i; |
@@ -331,6 +343,7 @@ MACHINE_START(REALVIEW_PB1176, "ARM-RealView PB1176") | |||
331 | .phys_io = REALVIEW_PB1176_UART0_BASE, | 343 | .phys_io = REALVIEW_PB1176_UART0_BASE, |
332 | .io_pg_offst = (IO_ADDRESS(REALVIEW_PB1176_UART0_BASE) >> 18) & 0xfffc, | 344 | .io_pg_offst = (IO_ADDRESS(REALVIEW_PB1176_UART0_BASE) >> 18) & 0xfffc, |
333 | .boot_params = PHYS_OFFSET + 0x00000100, | 345 | .boot_params = PHYS_OFFSET + 0x00000100, |
346 | .fixup = realview_pb1176_fixup, | ||
334 | .map_io = realview_pb1176_map_io, | 347 | .map_io = realview_pb1176_map_io, |
335 | .init_irq = gic_init_irq, | 348 | .init_irq = gic_init_irq, |
336 | .timer = &realview_pb1176_timer, | 349 | .timer = &realview_pb1176_timer, |
diff --git a/arch/arm/mach-realview/realview_pb11mp.c b/arch/arm/mach-realview/realview_pb11mp.c index 070d284ce96e..9bbbfc05f225 100644 --- a/arch/arm/mach-realview/realview_pb11mp.c +++ b/arch/arm/mach-realview/realview_pb11mp.c | |||
@@ -347,6 +347,7 @@ MACHINE_START(REALVIEW_PB11MP, "ARM-RealView PB11MPCore") | |||
347 | .phys_io = REALVIEW_PB11MP_UART0_BASE, | 347 | .phys_io = REALVIEW_PB11MP_UART0_BASE, |
348 | .io_pg_offst = (IO_ADDRESS(REALVIEW_PB11MP_UART0_BASE) >> 18) & 0xfffc, | 348 | .io_pg_offst = (IO_ADDRESS(REALVIEW_PB11MP_UART0_BASE) >> 18) & 0xfffc, |
349 | .boot_params = PHYS_OFFSET + 0x00000100, | 349 | .boot_params = PHYS_OFFSET + 0x00000100, |
350 | .fixup = realview_fixup, | ||
350 | .map_io = realview_pb11mp_map_io, | 351 | .map_io = realview_pb11mp_map_io, |
351 | .init_irq = gic_init_irq, | 352 | .init_irq = gic_init_irq, |
352 | .timer = &realview_pb11mp_timer, | 353 | .timer = &realview_pb11mp_timer, |
diff --git a/arch/arm/mach-realview/realview_pba8.c b/arch/arm/mach-realview/realview_pba8.c index 941beb2b9709..fe861e96c566 100644 --- a/arch/arm/mach-realview/realview_pba8.c +++ b/arch/arm/mach-realview/realview_pba8.c | |||
@@ -298,6 +298,7 @@ MACHINE_START(REALVIEW_PBA8, "ARM-RealView PB-A8") | |||
298 | .phys_io = REALVIEW_PBA8_UART0_BASE, | 298 | .phys_io = REALVIEW_PBA8_UART0_BASE, |
299 | .io_pg_offst = (IO_ADDRESS(REALVIEW_PBA8_UART0_BASE) >> 18) & 0xfffc, | 299 | .io_pg_offst = (IO_ADDRESS(REALVIEW_PBA8_UART0_BASE) >> 18) & 0xfffc, |
300 | .boot_params = PHYS_OFFSET + 0x00000100, | 300 | .boot_params = PHYS_OFFSET + 0x00000100, |
301 | .fixup = realview_fixup, | ||
301 | .map_io = realview_pba8_map_io, | 302 | .map_io = realview_pba8_map_io, |
302 | .init_irq = gic_init_irq, | 303 | .init_irq = gic_init_irq, |
303 | .timer = &realview_pba8_timer, | 304 | .timer = &realview_pba8_timer, |
diff --git a/arch/arm/mach-realview/realview_pbx.c b/arch/arm/mach-realview/realview_pbx.c index 7e4bc6cdca52..ec39488e2b42 100644 --- a/arch/arm/mach-realview/realview_pbx.c +++ b/arch/arm/mach-realview/realview_pbx.c | |||
@@ -304,6 +304,26 @@ static struct sys_timer realview_pbx_timer = { | |||
304 | .init = realview_pbx_timer_init, | 304 | .init = realview_pbx_timer_init, |
305 | }; | 305 | }; |
306 | 306 | ||
307 | static void realview_pbx_fixup(struct machine_desc *mdesc, struct tag *tags, | ||
308 | char **from, struct meminfo *meminfo) | ||
309 | { | ||
310 | #ifdef CONFIG_SPARSEMEM | ||
311 | /* | ||
312 | * Memory configuration with SPARSEMEM enabled on RealView PBX (see | ||
313 | * asm/mach/memory.h for more information). | ||
314 | */ | ||
315 | meminfo->bank[0].start = 0; | ||
316 | meminfo->bank[0].size = SZ_256M; | ||
317 | meminfo->bank[1].start = 0x20000000; | ||
318 | meminfo->bank[1].size = SZ_512M; | ||
319 | meminfo->bank[2].start = 0x80000000; | ||
320 | meminfo->bank[2].size = SZ_256M; | ||
321 | meminfo->nr_banks = 3; | ||
322 | #else | ||
323 | realview_fixup(mdesc, tags, from, meminfo); | ||
324 | #endif | ||
325 | } | ||
326 | |||
307 | static void __init realview_pbx_init(void) | 327 | static void __init realview_pbx_init(void) |
308 | { | 328 | { |
309 | int i; | 329 | int i; |
@@ -345,6 +365,7 @@ MACHINE_START(REALVIEW_PBX, "ARM-RealView PBX") | |||
345 | .phys_io = REALVIEW_PBX_UART0_BASE, | 365 | .phys_io = REALVIEW_PBX_UART0_BASE, |
346 | .io_pg_offst = (IO_ADDRESS(REALVIEW_PBX_UART0_BASE) >> 18) & 0xfffc, | 366 | .io_pg_offst = (IO_ADDRESS(REALVIEW_PBX_UART0_BASE) >> 18) & 0xfffc, |
347 | .boot_params = PHYS_OFFSET + 0x00000100, | 367 | .boot_params = PHYS_OFFSET + 0x00000100, |
368 | .fixup = realview_pbx_fixup, | ||
348 | .map_io = realview_pbx_map_io, | 369 | .map_io = realview_pbx_map_io, |
349 | .init_irq = gic_init_irq, | 370 | .init_irq = gic_init_irq, |
350 | .timer = &realview_pbx_timer, | 371 | .timer = &realview_pbx_timer, |
diff --git a/arch/arm/mm/proc-v7.S b/arch/arm/mm/proc-v7.S index eeeed01ee44a..3a285218fd15 100644 --- a/arch/arm/mm/proc-v7.S +++ b/arch/arm/mm/proc-v7.S | |||
@@ -186,9 +186,10 @@ cpu_v7_name: | |||
186 | */ | 186 | */ |
187 | __v7_setup: | 187 | __v7_setup: |
188 | #ifdef CONFIG_SMP | 188 | #ifdef CONFIG_SMP |
189 | mrc p15, 0, r0, c1, c0, 1 @ Enable SMP/nAMP mode and | 189 | mrc p15, 0, r0, c1, c0, 1 |
190 | orr r0, r0, #(1 << 6) | (1 << 0) @ TLB ops broadcasting | 190 | tst r0, #(1 << 6) @ SMP/nAMP mode enabled? |
191 | mcr p15, 0, r0, c1, c0, 1 | 191 | orreq r0, r0, #(1 << 6) | (1 << 0) @ Enable SMP/nAMP mode and |
192 | mcreq p15, 0, r0, c1, c0, 1 @ TLB ops broadcasting | ||
192 | #endif | 193 | #endif |
193 | adr r12, __v7_setup_stack @ the local stack | 194 | adr r12, __v7_setup_stack @ the local stack |
194 | stmia r12, {r0-r5, r7, r9, r11, lr} | 195 | stmia r12, {r0-r5, r7, r9, r11, lr} |