Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2000, 2001, 2002, 2003 Broadcom Corporation |
| 3 | * |
| 4 | * This program is free software; you can redistribute it and/or |
| 5 | * modify it under the terms of the GNU General Public License |
| 6 | * as published by the Free Software Foundation; either version 2 |
| 7 | * of the License, or (at your option) any later version. |
| 8 | * |
| 9 | * This program is distributed in the hope that it will be useful, |
| 10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 12 | * GNU General Public License for more details. |
| 13 | * |
| 14 | * You should have received a copy of the GNU General Public License |
| 15 | * along with this program; if not, write to the Free Software |
| 16 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. |
| 17 | */ |
| 18 | |
| 19 | #include <linux/init.h> |
| 20 | #include <linux/sched.h> |
| 21 | #include <linux/smp.h> |
| 22 | #include <asm/processor.h> |
| 23 | |
| 24 | #include "cfe_api.h" |
| 25 | #include "cfe_error.h" |
| 26 | |
| 27 | /* |
| 28 | * Use CFE to find out how many CPUs are available, setting up |
| 29 | * phys_cpu_present_map and the logical/physical mappings. |
| 30 | * XXXKW will the boot CPU ever not be physical 0? |
| 31 | * |
| 32 | * Common setup before any secondaries are started |
| 33 | */ |
Ralf Baechle | 9b6695a | 2006-02-23 12:23:27 +0000 | [diff] [blame] | 34 | void __init plat_smp_setup(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 35 | { |
| 36 | int i, num; |
| 37 | |
| 38 | cpus_clear(phys_cpu_present_map); |
| 39 | cpu_set(0, phys_cpu_present_map); |
| 40 | __cpu_number_map[0] = 0; |
| 41 | __cpu_logical_map[0] = 0; |
| 42 | |
Ralf Baechle | 9b6695a | 2006-02-23 12:23:27 +0000 | [diff] [blame] | 43 | for (i = 1, num = 0; i < NR_CPUS; i++) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 | if (cfe_cpu_stop(i) == 0) { |
| 45 | cpu_set(i, phys_cpu_present_map); |
| 46 | __cpu_number_map[i] = ++num; |
| 47 | __cpu_logical_map[num] = i; |
| 48 | } |
| 49 | } |
Ralf Baechle | 9b6695a | 2006-02-23 12:23:27 +0000 | [diff] [blame] | 50 | printk(KERN_INFO "Detected %i available secondary CPU(s)\n", num); |
| 51 | } |
| 52 | |
| 53 | void __init plat_prepare_cpus(unsigned int max_cpus) |
| 54 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 55 | } |
| 56 | |
| 57 | /* |
| 58 | * Setup the PC, SP, and GP of a secondary processor and start it |
| 59 | * running! |
| 60 | */ |
| 61 | void prom_boot_secondary(int cpu, struct task_struct *idle) |
| 62 | { |
| 63 | int retval; |
Ralf Baechle | 42a3b4f | 2005-09-03 15:56:17 -0700 | [diff] [blame] | 64 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 65 | retval = cfe_cpu_start(cpu_logical_map(cpu), &smp_bootstrap, |
| 66 | __KSTK_TOS(idle), |
Al Viro | dc8f602 | 2006-01-12 01:06:07 -0800 | [diff] [blame] | 67 | (unsigned long)task_thread_info(idle), 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 68 | if (retval != 0) |
| 69 | printk("cfe_start_cpu(%i) returned %i\n" , cpu, retval); |
| 70 | } |
| 71 | |
| 72 | /* |
| 73 | * Code to run on secondary just after probing the CPU |
| 74 | */ |
| 75 | void prom_init_secondary(void) |
| 76 | { |
Andrew Isaacson | f137e46 | 2005-10-19 23:56:38 -0700 | [diff] [blame] | 77 | #if defined(CONFIG_SIBYTE_BCM1x55) || defined(CONFIG_SIBYTE_BCM1x80) |
| 78 | extern void bcm1480_smp_init(void); |
| 79 | bcm1480_smp_init(); |
| 80 | #elif defined(CONFIG_SIBYTE_SB1250) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | extern void sb1250_smp_init(void); |
| 82 | sb1250_smp_init(); |
Andrew Isaacson | f137e46 | 2005-10-19 23:56:38 -0700 | [diff] [blame] | 83 | #else |
| 84 | #error invalid SMP configuration |
| 85 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 86 | } |
| 87 | |
| 88 | /* |
| 89 | * Do any tidying up before marking online and running the idle |
| 90 | * loop |
| 91 | */ |
| 92 | void prom_smp_finish(void) |
| 93 | { |
Andrew Isaacson | f137e46 | 2005-10-19 23:56:38 -0700 | [diff] [blame] | 94 | #if defined(CONFIG_SIBYTE_BCM1x55) || defined(CONFIG_SIBYTE_BCM1x80) |
| 95 | extern void bcm1480_smp_finish(void); |
| 96 | bcm1480_smp_finish(); |
| 97 | #elif defined(CONFIG_SIBYTE_SB1250) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 98 | extern void sb1250_smp_finish(void); |
| 99 | sb1250_smp_finish(); |
Andrew Isaacson | f137e46 | 2005-10-19 23:56:38 -0700 | [diff] [blame] | 100 | #else |
| 101 | #error invalid SMP configuration |
| 102 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 103 | } |
| 104 | |
| 105 | /* |
| 106 | * Final cleanup after all secondaries booted |
| 107 | */ |
| 108 | void prom_cpus_done(void) |
| 109 | { |
| 110 | } |