From mboxrd@z Thu Jan 1 00:00:00 1970 From: Kumar Gala Date: Tue, 12 Jan 2010 13:03:30 -0600 Subject: [U-Boot] [PATCH 3/3] 85xx: Add support for 'cpu disable' command In-Reply-To: <1263323010-30799-2-git-send-email-galak@kernel.crashing.org> References: <1263323010-30799-1-git-send-email-galak@kernel.crashing.org> <1263323010-30799-2-git-send-email-galak@kernel.crashing.org> Message-ID: <1263323010-30799-3-git-send-email-galak@kernel.crashing.org> List-Id: MIME-Version: 1.0 Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit To: u-boot@lists.denx.de Support disabling of a core via user command 'cpu disable'. Signed-off-by: Kumar Gala --- cpu/mpc85xx/mp.c | 28 ++++++++++++++++++++++++++-- 1 files changed, 26 insertions(+), 2 deletions(-) diff --git a/cpu/mpc85xx/mp.c b/cpu/mpc85xx/mp.c index 6ae7f0a..73c7f87 100644 --- a/cpu/mpc85xx/mp.c +++ b/cpu/mpc85xx/mp.c @@ -68,11 +68,35 @@ int cpu_status(int nr) return 0; } +#ifdef CONFIG_FSL_CORENET int cpu_disable(int nr) { - /* dummy function so common/cmd_mp.c will build */ - return 1; + volatile ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR); + + setbits_be32(&gur->coredisrl, nr); + + return 0; } +#else +int cpu_disable(int nr) +{ + volatile ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR); + + switch (nr) { + case 0: + setbits_be32(&gur->devdisr, MPC85xx_DEVDISR_CPU0); + break; + case 1: + setbits_be32(&gur->devdisr, MPC85xx_DEVDISR_CPU1); + break; + default: + printf("Invalid cpu number for disable %d\n", nr); + return 1; + } + + return 0; +} +#endif static u8 boot_entry_map[4] = { 0, -- 1.6.0.6