| Russell King | a8cbcd9 | 2009-05-16 11:51:14 +0100 | [diff] [blame^] | 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 | } |