| 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> | 
| Catalin Marinas | af73110 | 2009-05-18 16:26:27 +0100 | [diff] [blame] | 15 | #include <asm/cacheflush.h> | 
| Russell King | a8cbcd9 | 2009-05-16 11:51:14 +0100 | [diff] [blame] | 16 |  | 
 | 17 | #define SCU_CTRL		0x00 | 
 | 18 | #define SCU_CONFIG		0x04 | 
 | 19 | #define SCU_CPU_STATUS		0x08 | 
 | 20 | #define SCU_INVALIDATE		0x0c | 
 | 21 | #define SCU_FPGA_REVISION	0x10 | 
 | 22 |  | 
 | 23 | /* | 
 | 24 |  * Get the number of CPU cores from the SCU configuration | 
 | 25 |  */ | 
 | 26 | unsigned int __init scu_get_core_count(void __iomem *scu_base) | 
 | 27 | { | 
 | 28 | 	unsigned int ncores = __raw_readl(scu_base + SCU_CONFIG); | 
 | 29 | 	return (ncores & 0x03) + 1; | 
 | 30 | } | 
 | 31 |  | 
 | 32 | /* | 
 | 33 |  * Enable the SCU | 
 | 34 |  */ | 
 | 35 | void __init scu_enable(void __iomem *scu_base) | 
 | 36 | { | 
 | 37 | 	u32 scu_ctrl; | 
 | 38 |  | 
 | 39 | 	scu_ctrl = __raw_readl(scu_base + SCU_CTRL); | 
| Catalin Marinas | 9b229fa | 2009-11-04 12:16:38 +0000 | [diff] [blame] | 40 | 	/* already enabled? */ | 
 | 41 | 	if (scu_ctrl & 1) | 
 | 42 | 		return; | 
 | 43 |  | 
| Russell King | a8cbcd9 | 2009-05-16 11:51:14 +0100 | [diff] [blame] | 44 | 	scu_ctrl |= 1; | 
 | 45 | 	__raw_writel(scu_ctrl, scu_base + SCU_CTRL); | 
| Catalin Marinas | af73110 | 2009-05-18 16:26:27 +0100 | [diff] [blame] | 46 |  | 
 | 47 | 	/* | 
 | 48 | 	 * Ensure that the data accessed by CPU0 before the SCU was | 
 | 49 | 	 * initialised is visible to the other CPUs. | 
 | 50 | 	 */ | 
 | 51 | 	flush_cache_all(); | 
| Russell King | a8cbcd9 | 2009-05-16 11:51:14 +0100 | [diff] [blame] | 52 | } |