[ARM] smp: separate SCU support code from realview
[linux-2.6] / arch / arm / kernel / smp_scu.c
1 /*
2  *  linux/arch/arm/kernel/smp_scu.c
3  *
4  *  Copyright (C) 2002 ARM Ltd.
5  *  All Rights Reserved
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  */
11 #include <linux/init.h>
12 #include <linux/io.h>
13
14 #include <asm/smp_scu.h>
15
16 #define SCU_CTRL                0x00
17 #define SCU_CONFIG              0x04
18 #define SCU_CPU_STATUS          0x08
19 #define SCU_INVALIDATE          0x0c
20 #define SCU_FPGA_REVISION       0x10
21
22 /*
23  * Get the number of CPU cores from the SCU configuration
24  */
25 unsigned int __init scu_get_core_count(void __iomem *scu_base)
26 {
27         unsigned int ncores = __raw_readl(scu_base + SCU_CONFIG);
28         return (ncores & 0x03) + 1;
29 }
30
31 /*
32  * Enable the SCU
33  */
34 void __init scu_enable(void __iomem *scu_base)
35 {
36         u32 scu_ctrl;
37
38         scu_ctrl = __raw_readl(scu_base + SCU_CTRL);
39         scu_ctrl |= 1;
40         __raw_writel(scu_ctrl, scu_base + SCU_CTRL);
41 }