arch/x86/kernel/smpboot_32.c - maze/linux - Git at Google

 /*
  *	x86 SMP booting functions
  *
  *	(c) 1995 Alan Cox, Building #3 <alan@redhat.com>
  *	(c) 1998, 1999, 2000 Ingo Molnar <mingo@redhat.com>
  *
  *	Much of the core SMP work is based on previous work by Thomas Radke, to
  *	whom a great many thanks are extended.
  *
  *	Thanks to Intel for making available several different Pentium,
  *	Pentium Pro and Pentium-II/Xeon MP machines.
  *	Original development of Linux SMP code supported by Caldera.
  *
  *	This code is released under the GNU General Public License version 2 or
  *	later.
  *
  *	Fixes
  *		Felix Koop	:	NR_CPUS used properly
  *		Jose Renau	:	Handle single CPU case.
  *		Alan Cox	:	By repeated request 8) - Total BogoMIPS report.
  *		Greg Wright	:	Fix for kernel stacks panic.
  *		Erich Boleyn	:	MP v1.4 and additional changes.
  *	Matthias Sattler	:	Changes for 2.1 kernel map.
  *	Michel Lespinasse	:	Changes for 2.1 kernel map.
  *	Michael Chastain	:	Change trampoline.S to gnu as.
  *		Alan Cox	:	Dumb bug: 'B' step PPro's are fine
  *		Ingo Molnar	:	Added APIC timers, based on code
  *					from Jose Renau
  *		Ingo Molnar	:	various cleanups and rewrites
  *		Tigran Aivazian	:	fixed "0.00 in /proc/uptime on SMP" bug.
  *	Maciej W. Rozycki	:	Bits for genuine 82489DX APICs
  *		Martin J. Bligh	: 	Added support for multi-quad systems
  *		Dave Jones	:	Report invalid combinations of Athlon CPUs.
 *		Rusty Russell	:	Hacked into shape for new "hotplug" boot process. */

 #include <linux/module.h>
 #include <linux/init.h>
 #include <linux/kernel.h>

 #include <linux/mm.h>
 #include <linux/sched.h>
 #include <linux/kernel_stat.h>
 #include <linux/bootmem.h>
 #include <linux/notifier.h>
 #include <linux/cpu.h>
 #include <linux/percpu.h>
 #include <linux/nmi.h>

 #include <linux/delay.h>
 #include <linux/mc146818rtc.h>
 #include <asm/tlbflush.h>
 #include <asm/desc.h>
 #include <asm/arch_hooks.h>
 #include <asm/nmi.h>

 #include <mach_apic.h>
 #include <mach_wakecpu.h>
 #include <smpboot_hooks.h>
 #include <asm/vmi.h>
 #include <asm/mtrr.h>

 /* which logical CPU number maps to which CPU (physical APIC ID) */
 u16 x86_cpu_to_apicid_init[NR_CPUS] __initdata =
 			{ [0 ... NR_CPUS-1] = BAD_APICID };
 void *x86_cpu_to_apicid_early_ptr;
 DEFINE_PER_CPU(u16, x86_cpu_to_apicid) = BAD_APICID;
 EXPORT_PER_CPU_SYMBOL(x86_cpu_to_apicid);

 u16 x86_bios_cpu_apicid_init[NR_CPUS] __initdata
 				= { [0 ... NR_CPUS-1] = BAD_APICID };
 void *x86_bios_cpu_apicid_early_ptr;
 DEFINE_PER_CPU(u16, x86_bios_cpu_apicid) = BAD_APICID;
 EXPORT_PER_CPU_SYMBOL(x86_bios_cpu_apicid);

 u8 apicid_2_node[MAX_APICID];

 extern void map_cpu_to_logical_apicid(void);
 extern void unmap_cpu_to_logical_apicid(int cpu);

 #ifdef CONFIG_HOTPLUG_CPU
 void cpu_exit_clear(void)
 {
 	int cpu = raw_smp_processor_id();

 	idle_task_exit();

 	cpu_uninit();
 	irq_ctx_exit(cpu);

 	cpu_clear(cpu, cpu_callout_map);
 	cpu_clear(cpu, cpu_callin_map);

 	unmap_cpu_to_logical_apicid(cpu);
 }
 #endif

 static int boot_cpu_logical_apicid;
 /* Where the IO area was mapped on multiquad, always 0 otherwise */
 void *xquad_portio;
 #ifdef CONFIG_X86_NUMAQ
 EXPORT_SYMBOL(xquad_portio);
 #endif

 static void __init disable_smp(void)
 {
 	cpu_possible_map = cpumask_of_cpu(0);
 	cpu_present_map = cpumask_of_cpu(0);
 	smpboot_clear_io_apic_irqs();
 	if (smp_found_config)
 		phys_cpu_present_map =
 				physid_mask_of_physid(boot_cpu_physical_apicid);
 	else
 		phys_cpu_present_map = physid_mask_of_physid(0);
 	map_cpu_to_logical_apicid();
 	cpu_set(0, per_cpu(cpu_sibling_map, 0));
 	cpu_set(0, per_cpu(cpu_core_map, 0));
 }

 static int __init smp_sanity_check(unsigned max_cpus)
 {
 	if (!physid_isset(hard_smp_processor_id(), phys_cpu_present_map)) {
 		printk(KERN_WARNING "weird, boot CPU (#%d) not listed"
 				    "by the BIOS.\n", hard_smp_processor_id());
 		physid_set(hard_smp_processor_id(), phys_cpu_present_map);
 	}

 	/*
 	 * If we couldn't find an SMP configuration at boot time,
 	 * get out of here now!
 	 */
 	if (!smp_found_config && !acpi_lapic) {
 		printk(KERN_NOTICE "SMP motherboard not detected.\n");
 		disable_smp();
 		if (APIC_init_uniprocessor())
 			printk(KERN_NOTICE "Local APIC not detected."
 					   " Using dummy APIC emulation.\n");
 		return -1;
 	}

 	/*
 	 * Should not be necessary because the MP table should list the boot
 	 * CPU too, but we do it for the sake of robustness anyway.
 	 * Makes no sense to do this check in clustered apic mode, so skip it
 	 */
 	if (!check_phys_apicid_present(boot_cpu_physical_apicid)) {
 		printk("weird, boot CPU (#%d) not listed by the BIOS.\n",
 				boot_cpu_physical_apicid);
 		physid_set(hard_smp_processor_id(), phys_cpu_present_map);
 	}

 	/*
 	 * If we couldn't find a local APIC, then get out of here now!
 	 */
 	if (APIC_INTEGRATED(apic_version[boot_cpu_physical_apicid]) && !cpu_has_apic) {
 		printk(KERN_ERR "BIOS bug, local APIC #%d not detected!...\n",
 			boot_cpu_physical_apicid);
 		printk(KERN_ERR "... forcing use of dummy APIC emulation. (tell your hw vendor)\n");
 		smpboot_clear_io_apic();
 		return -1;
 	}

 	verify_local_APIC();

 	/*
 	 * If SMP should be disabled, then really disable it!
 	 */
 	if (!max_cpus) {
 		smp_found_config = 0;
 		printk(KERN_INFO "SMP mode deactivated, forcing use of dummy APIC emulation.\n");

 		if (nmi_watchdog == NMI_LOCAL_APIC) {
 			printk(KERN_INFO "activating minimal APIC for NMI watchdog use.\n");
 			connect_bsp_APIC();
 			setup_local_APIC();
 			end_local_APIC_setup();
 		}
 		smpboot_clear_io_apic();
 		return -1;
 	}
 	return 0;
 }

 static void __init smp_cpu_index_default(void)
 {
 	int i;
 	struct cpuinfo_x86 *c;

 	for_each_cpu_mask(i, cpu_possible_map) {
 		c = &cpu_data(i);
 		/* mark all to hotplug */
 		c->cpu_index = NR_CPUS;
 	}
 }

 void __init native_smp_prepare_cpus(unsigned int max_cpus)
 {
  	nmi_watchdog_default();
  	smp_cpu_index_default();
  	current_cpu_data = boot_cpu_data;
  	cpu_callin_map = cpumask_of_cpu(0);
  	mb();

 	/*
 	 * Setup boot CPU information
 	 */
 	smp_store_cpu_info(0); /* Final full version of the data */
 	boot_cpu_logical_apicid = logical_smp_processor_id();
 	current_thread_info()->cpu = 0;

 	set_cpu_sibling_map(0);

 	if (smp_sanity_check(max_cpus) < 0) {
 		printk(KERN_INFO "SMP disabled\n");
 		disable_smp();
 		return;
 	}

 	if (GET_APIC_ID(apic_read(APIC_ID)) != boot_cpu_physical_apicid) {
 		panic("Boot APIC ID in local APIC unexpected (%d vs %d)",
 		     GET_APIC_ID(apic_read(APIC_ID)), boot_cpu_physical_apicid);
 		/* Or can we switch back to PIC here? */
 	}

 	connect_bsp_APIC();
 	setup_local_APIC();
 	end_local_APIC_setup();
 	map_cpu_to_logical_apicid();

 	setup_portio_remap();

 	smpboot_setup_io_apic();

 	printk(KERN_INFO "CPU%d: ", 0);
 	print_cpu_info(&cpu_data(0));
 	setup_boot_clock();
 }
	/*
	* x86 SMP booting functions
	*
	* (c) 1995 Alan Cox, Building #3 <alan@redhat.com>
	* (c) 1998, 1999, 2000 Ingo Molnar <mingo@redhat.com>
	*
	* Much of the core SMP work is based on previous work by Thomas Radke, to
	* whom a great many thanks are extended.
	*
	* Thanks to Intel for making available several different Pentium,
	* Pentium Pro and Pentium-II/Xeon MP machines.
	* Original development of Linux SMP code supported by Caldera.
	*
	* This code is released under the GNU General Public License version 2 or
	* later.
	*
	* Fixes
	* Felix Koop : NR_CPUS used properly
	* Jose Renau : Handle single CPU case.
	* Alan Cox : By repeated request 8) - Total BogoMIPS report.
	* Greg Wright : Fix for kernel stacks panic.
	* Erich Boleyn : MP v1.4 and additional changes.
	* Matthias Sattler : Changes for 2.1 kernel map.
	* Michel Lespinasse : Changes for 2.1 kernel map.
	* Michael Chastain : Change trampoline.S to gnu as.
	* Alan Cox : Dumb bug: 'B' step PPro's are fine
	* Ingo Molnar : Added APIC timers, based on code
	* from Jose Renau
	* Ingo Molnar : various cleanups and rewrites
	* Tigran Aivazian : fixed "0.00 in /proc/uptime on SMP" bug.
	* Maciej W. Rozycki : Bits for genuine 82489DX APICs
	* Martin J. Bligh : Added support for multi-quad systems
	* Dave Jones : Report invalid combinations of Athlon CPUs.
	* Rusty Russell : Hacked into shape for new "hotplug" boot process. */

	#include <linux/module.h>
	#include <linux/init.h>
	#include <linux/kernel.h>

	#include <linux/mm.h>
	#include <linux/sched.h>
	#include <linux/kernel_stat.h>
	#include <linux/bootmem.h>
	#include <linux/notifier.h>
	#include <linux/cpu.h>
	#include <linux/percpu.h>
	#include <linux/nmi.h>

	#include <linux/delay.h>
	#include <linux/mc146818rtc.h>
	#include <asm/tlbflush.h>
	#include <asm/desc.h>
	#include <asm/arch_hooks.h>
	#include <asm/nmi.h>

	#include <mach_apic.h>
	#include <mach_wakecpu.h>
	#include <smpboot_hooks.h>
	#include <asm/vmi.h>
	#include <asm/mtrr.h>

	/* which logical CPU number maps to which CPU (physical APIC ID) */
	u16 x86_cpu_to_apicid_init[NR_CPUS] __initdata =
	{ [0 ... NR_CPUS-1] = BAD_APICID };
	void *x86_cpu_to_apicid_early_ptr;
	DEFINE_PER_CPU(u16, x86_cpu_to_apicid) = BAD_APICID;
	EXPORT_PER_CPU_SYMBOL(x86_cpu_to_apicid);

	u16 x86_bios_cpu_apicid_init[NR_CPUS] __initdata
	= { [0 ... NR_CPUS-1] = BAD_APICID };
	void *x86_bios_cpu_apicid_early_ptr;
	DEFINE_PER_CPU(u16, x86_bios_cpu_apicid) = BAD_APICID;
	EXPORT_PER_CPU_SYMBOL(x86_bios_cpu_apicid);

	u8 apicid_2_node[MAX_APICID];

	extern void map_cpu_to_logical_apicid(void);
	extern void unmap_cpu_to_logical_apicid(int cpu);

	#ifdef CONFIG_HOTPLUG_CPU
	void cpu_exit_clear(void)
	{
	int cpu = raw_smp_processor_id();

	idle_task_exit();

	cpu_uninit();
	irq_ctx_exit(cpu);

	cpu_clear(cpu, cpu_callout_map);
	cpu_clear(cpu, cpu_callin_map);

	unmap_cpu_to_logical_apicid(cpu);
	}
	#endif

	static int boot_cpu_logical_apicid;
	/* Where the IO area was mapped on multiquad, always 0 otherwise */
	void *xquad_portio;
	#ifdef CONFIG_X86_NUMAQ
	EXPORT_SYMBOL(xquad_portio);
	#endif

	static void __init disable_smp(void)
	{
	cpu_possible_map = cpumask_of_cpu(0);
	cpu_present_map = cpumask_of_cpu(0);
	smpboot_clear_io_apic_irqs();
	if (smp_found_config)
	phys_cpu_present_map =
	physid_mask_of_physid(boot_cpu_physical_apicid);
	else
	phys_cpu_present_map = physid_mask_of_physid(0);
	map_cpu_to_logical_apicid();
	cpu_set(0, per_cpu(cpu_sibling_map, 0));
	cpu_set(0, per_cpu(cpu_core_map, 0));
	}

	static int __init smp_sanity_check(unsigned max_cpus)
	{
	if (!physid_isset(hard_smp_processor_id(), phys_cpu_present_map)) {
	printk(KERN_WARNING "weird, boot CPU (#%d) not listed"
	"by the BIOS.\n", hard_smp_processor_id());
	physid_set(hard_smp_processor_id(), phys_cpu_present_map);
	}

	/*
	* If we couldn't find an SMP configuration at boot time,
	* get out of here now!
	*/
	if (!smp_found_config && !acpi_lapic) {
	printk(KERN_NOTICE "SMP motherboard not detected.\n");
	disable_smp();
	if (APIC_init_uniprocessor())
	printk(KERN_NOTICE "Local APIC not detected."
	" Using dummy APIC emulation.\n");
	return -1;
	}

	/*
	* Should not be necessary because the MP table should list the boot
	* CPU too, but we do it for the sake of robustness anyway.
	* Makes no sense to do this check in clustered apic mode, so skip it
	*/
	if (!check_phys_apicid_present(boot_cpu_physical_apicid)) {
	printk("weird, boot CPU (#%d) not listed by the BIOS.\n",
	boot_cpu_physical_apicid);
	physid_set(hard_smp_processor_id(), phys_cpu_present_map);
	}

	/*
	* If we couldn't find a local APIC, then get out of here now!
	*/
	if (APIC_INTEGRATED(apic_version[boot_cpu_physical_apicid]) && !cpu_has_apic) {
	printk(KERN_ERR "BIOS bug, local APIC #%d not detected!...\n",
	boot_cpu_physical_apicid);
	printk(KERN_ERR "... forcing use of dummy APIC emulation. (tell your hw vendor)\n");
	smpboot_clear_io_apic();
	return -1;
	}

	verify_local_APIC();

	/*
	* If SMP should be disabled, then really disable it!
	*/
	if (!max_cpus) {
	smp_found_config = 0;
	printk(KERN_INFO "SMP mode deactivated, forcing use of dummy APIC emulation.\n");

	if (nmi_watchdog == NMI_LOCAL_APIC) {
	printk(KERN_INFO "activating minimal APIC for NMI watchdog use.\n");
	connect_bsp_APIC();
	setup_local_APIC();
	end_local_APIC_setup();
	}
	smpboot_clear_io_apic();
	return -1;
	}
	return 0;
	}

	static void __init smp_cpu_index_default(void)
	{
	int i;
	struct cpuinfo_x86 *c;

	for_each_cpu_mask(i, cpu_possible_map) {
	c = &cpu_data(i);
	/* mark all to hotplug */
	c->cpu_index = NR_CPUS;
	}
	}

	void __init native_smp_prepare_cpus(unsigned int max_cpus)
	{
	nmi_watchdog_default();
	smp_cpu_index_default();
	current_cpu_data = boot_cpu_data;
	cpu_callin_map = cpumask_of_cpu(0);
	mb();

	/*
	* Setup boot CPU information
	*/
	smp_store_cpu_info(0); /* Final full version of the data */
	boot_cpu_logical_apicid = logical_smp_processor_id();
	current_thread_info()->cpu = 0;

	set_cpu_sibling_map(0);

	if (smp_sanity_check(max_cpus) < 0) {
	printk(KERN_INFO "SMP disabled\n");
	disable_smp();
	return;
	}

	if (GET_APIC_ID(apic_read(APIC_ID)) != boot_cpu_physical_apicid) {
	panic("Boot APIC ID in local APIC unexpected (%d vs %d)",
	GET_APIC_ID(apic_read(APIC_ID)), boot_cpu_physical_apicid);
	/* Or can we switch back to PIC here? */
	}

	connect_bsp_APIC();
	setup_local_APIC();
	end_local_APIC_setup();
	map_cpu_to_logical_apicid();

	setup_portio_remap();

	smpboot_setup_io_apic();

	printk(KERN_INFO "CPU%d: ", 0);
	print_cpu_info(&cpu_data(0));
	setup_boot_clock();
	}