162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * SMP boot-related support 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 1998-2003, 2005 Hewlett-Packard Co 662306a36Sopenharmony_ci * David Mosberger-Tang <davidm@hpl.hp.com> 762306a36Sopenharmony_ci * Copyright (C) 2001, 2004-2005 Intel Corp 862306a36Sopenharmony_ci * Rohit Seth <rohit.seth@intel.com> 962306a36Sopenharmony_ci * Suresh Siddha <suresh.b.siddha@intel.com> 1062306a36Sopenharmony_ci * Gordon Jin <gordon.jin@intel.com> 1162306a36Sopenharmony_ci * Ashok Raj <ashok.raj@intel.com> 1262306a36Sopenharmony_ci * 1362306a36Sopenharmony_ci * 01/05/16 Rohit Seth <rohit.seth@intel.com> Moved SMP booting functions from smp.c to here. 1462306a36Sopenharmony_ci * 01/04/27 David Mosberger <davidm@hpl.hp.com> Added ITC synching code. 1562306a36Sopenharmony_ci * 02/07/31 David Mosberger <davidm@hpl.hp.com> Switch over to hotplug-CPU boot-sequence. 1662306a36Sopenharmony_ci * smp_boot_cpus()/smp_commence() is replaced by 1762306a36Sopenharmony_ci * smp_prepare_cpus()/__cpu_up()/smp_cpus_done(). 1862306a36Sopenharmony_ci * 04/06/21 Ashok Raj <ashok.raj@intel.com> Added CPU Hotplug Support 1962306a36Sopenharmony_ci * 04/12/26 Jin Gordon <gordon.jin@intel.com> 2062306a36Sopenharmony_ci * 04/12/26 Rohit Seth <rohit.seth@intel.com> 2162306a36Sopenharmony_ci * Add multi-threading and multi-core detection 2262306a36Sopenharmony_ci * 05/01/30 Suresh Siddha <suresh.b.siddha@intel.com> 2362306a36Sopenharmony_ci * Setup cpu_sibling_map and cpu_core_map 2462306a36Sopenharmony_ci */ 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_ci#include <linux/module.h> 2762306a36Sopenharmony_ci#include <linux/acpi.h> 2862306a36Sopenharmony_ci#include <linux/memblock.h> 2962306a36Sopenharmony_ci#include <linux/cpu.h> 3062306a36Sopenharmony_ci#include <linux/delay.h> 3162306a36Sopenharmony_ci#include <linux/init.h> 3262306a36Sopenharmony_ci#include <linux/interrupt.h> 3362306a36Sopenharmony_ci#include <linux/irq.h> 3462306a36Sopenharmony_ci#include <linux/kernel.h> 3562306a36Sopenharmony_ci#include <linux/kernel_stat.h> 3662306a36Sopenharmony_ci#include <linux/mm.h> 3762306a36Sopenharmony_ci#include <linux/notifier.h> 3862306a36Sopenharmony_ci#include <linux/smp.h> 3962306a36Sopenharmony_ci#include <linux/spinlock.h> 4062306a36Sopenharmony_ci#include <linux/efi.h> 4162306a36Sopenharmony_ci#include <linux/percpu.h> 4262306a36Sopenharmony_ci#include <linux/bitops.h> 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_ci#include <linux/atomic.h> 4562306a36Sopenharmony_ci#include <asm/cache.h> 4662306a36Sopenharmony_ci#include <asm/current.h> 4762306a36Sopenharmony_ci#include <asm/delay.h> 4862306a36Sopenharmony_ci#include <asm/efi.h> 4962306a36Sopenharmony_ci#include <asm/io.h> 5062306a36Sopenharmony_ci#include <asm/irq.h> 5162306a36Sopenharmony_ci#include <asm/mca.h> 5262306a36Sopenharmony_ci#include <asm/page.h> 5362306a36Sopenharmony_ci#include <asm/processor.h> 5462306a36Sopenharmony_ci#include <asm/ptrace.h> 5562306a36Sopenharmony_ci#include <asm/sal.h> 5662306a36Sopenharmony_ci#include <asm/tlbflush.h> 5762306a36Sopenharmony_ci#include <asm/unistd.h> 5862306a36Sopenharmony_ci 5962306a36Sopenharmony_ci#define SMP_DEBUG 0 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ci#if SMP_DEBUG 6262306a36Sopenharmony_ci#define Dprintk(x...) printk(x) 6362306a36Sopenharmony_ci#else 6462306a36Sopenharmony_ci#define Dprintk(x...) 6562306a36Sopenharmony_ci#endif 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ci#ifdef CONFIG_HOTPLUG_CPU 6862306a36Sopenharmony_ci#ifdef CONFIG_PERMIT_BSP_REMOVE 6962306a36Sopenharmony_ci#define bsp_remove_ok 1 7062306a36Sopenharmony_ci#else 7162306a36Sopenharmony_ci#define bsp_remove_ok 0 7262306a36Sopenharmony_ci#endif 7362306a36Sopenharmony_ci 7462306a36Sopenharmony_ci/* 7562306a36Sopenharmony_ci * Global array allocated for NR_CPUS at boot time 7662306a36Sopenharmony_ci */ 7762306a36Sopenharmony_cistruct sal_to_os_boot sal_boot_rendez_state[NR_CPUS]; 7862306a36Sopenharmony_ci 7962306a36Sopenharmony_ci/* 8062306a36Sopenharmony_ci * start_ap in head.S uses this to store current booting cpu 8162306a36Sopenharmony_ci * info. 8262306a36Sopenharmony_ci */ 8362306a36Sopenharmony_cistruct sal_to_os_boot *sal_state_for_booting_cpu = &sal_boot_rendez_state[0]; 8462306a36Sopenharmony_ci 8562306a36Sopenharmony_ci#define set_brendez_area(x) (sal_state_for_booting_cpu = &sal_boot_rendez_state[(x)]); 8662306a36Sopenharmony_ci 8762306a36Sopenharmony_ci#else 8862306a36Sopenharmony_ci#define set_brendez_area(x) 8962306a36Sopenharmony_ci#endif 9062306a36Sopenharmony_ci 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci/* 9362306a36Sopenharmony_ci * ITC synchronization related stuff: 9462306a36Sopenharmony_ci */ 9562306a36Sopenharmony_ci#define MASTER (0) 9662306a36Sopenharmony_ci#define SLAVE (SMP_CACHE_BYTES/8) 9762306a36Sopenharmony_ci 9862306a36Sopenharmony_ci#define NUM_ROUNDS 64 /* magic value */ 9962306a36Sopenharmony_ci#define NUM_ITERS 5 /* likewise */ 10062306a36Sopenharmony_ci 10162306a36Sopenharmony_cistatic DEFINE_SPINLOCK(itc_sync_lock); 10262306a36Sopenharmony_cistatic volatile unsigned long go[SLAVE + 1]; 10362306a36Sopenharmony_ci 10462306a36Sopenharmony_ci#define DEBUG_ITC_SYNC 0 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_ciextern void start_ap (void); 10762306a36Sopenharmony_ciextern unsigned long ia64_iobase; 10862306a36Sopenharmony_ci 10962306a36Sopenharmony_cistruct task_struct *task_for_booting_cpu; 11062306a36Sopenharmony_ci 11162306a36Sopenharmony_ci/* 11262306a36Sopenharmony_ci * State for each CPU 11362306a36Sopenharmony_ci */ 11462306a36Sopenharmony_ciDEFINE_PER_CPU(int, cpu_state); 11562306a36Sopenharmony_ci 11662306a36Sopenharmony_cicpumask_t cpu_core_map[NR_CPUS] __cacheline_aligned; 11762306a36Sopenharmony_ciEXPORT_SYMBOL(cpu_core_map); 11862306a36Sopenharmony_ciDEFINE_PER_CPU_SHARED_ALIGNED(cpumask_t, cpu_sibling_map); 11962306a36Sopenharmony_ciEXPORT_PER_CPU_SYMBOL(cpu_sibling_map); 12062306a36Sopenharmony_ci 12162306a36Sopenharmony_ciint smp_num_siblings = 1; 12262306a36Sopenharmony_ci 12362306a36Sopenharmony_ci/* which logical CPU number maps to which CPU (physical APIC ID) */ 12462306a36Sopenharmony_civolatile int ia64_cpu_to_sapicid[NR_CPUS]; 12562306a36Sopenharmony_ciEXPORT_SYMBOL(ia64_cpu_to_sapicid); 12662306a36Sopenharmony_ci 12762306a36Sopenharmony_cistatic cpumask_t cpu_callin_map; 12862306a36Sopenharmony_ci 12962306a36Sopenharmony_cistruct smp_boot_data smp_boot_data __initdata; 13062306a36Sopenharmony_ci 13162306a36Sopenharmony_ciunsigned long ap_wakeup_vector = -1; /* External Int use to wakeup APs */ 13262306a36Sopenharmony_ci 13362306a36Sopenharmony_cichar __initdata no_int_routing; 13462306a36Sopenharmony_ci 13562306a36Sopenharmony_ciunsigned char smp_int_redirect; /* are INT and IPI redirectable by the chipset? */ 13662306a36Sopenharmony_ci 13762306a36Sopenharmony_ci#ifdef CONFIG_FORCE_CPEI_RETARGET 13862306a36Sopenharmony_ci#define CPEI_OVERRIDE_DEFAULT (1) 13962306a36Sopenharmony_ci#else 14062306a36Sopenharmony_ci#define CPEI_OVERRIDE_DEFAULT (0) 14162306a36Sopenharmony_ci#endif 14262306a36Sopenharmony_ci 14362306a36Sopenharmony_ciunsigned int force_cpei_retarget = CPEI_OVERRIDE_DEFAULT; 14462306a36Sopenharmony_ci 14562306a36Sopenharmony_cistatic int __init 14662306a36Sopenharmony_cicmdl_force_cpei(char *str) 14762306a36Sopenharmony_ci{ 14862306a36Sopenharmony_ci int value=0; 14962306a36Sopenharmony_ci 15062306a36Sopenharmony_ci get_option (&str, &value); 15162306a36Sopenharmony_ci force_cpei_retarget = value; 15262306a36Sopenharmony_ci 15362306a36Sopenharmony_ci return 1; 15462306a36Sopenharmony_ci} 15562306a36Sopenharmony_ci 15662306a36Sopenharmony_ci__setup("force_cpei=", cmdl_force_cpei); 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_cistatic int __init 15962306a36Sopenharmony_cinointroute (char *str) 16062306a36Sopenharmony_ci{ 16162306a36Sopenharmony_ci no_int_routing = 1; 16262306a36Sopenharmony_ci printk ("no_int_routing on\n"); 16362306a36Sopenharmony_ci return 1; 16462306a36Sopenharmony_ci} 16562306a36Sopenharmony_ci 16662306a36Sopenharmony_ci__setup("nointroute", nointroute); 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_cistatic void fix_b0_for_bsp(void) 16962306a36Sopenharmony_ci{ 17062306a36Sopenharmony_ci#ifdef CONFIG_HOTPLUG_CPU 17162306a36Sopenharmony_ci int cpuid; 17262306a36Sopenharmony_ci static int fix_bsp_b0 = 1; 17362306a36Sopenharmony_ci 17462306a36Sopenharmony_ci cpuid = smp_processor_id(); 17562306a36Sopenharmony_ci 17662306a36Sopenharmony_ci /* 17762306a36Sopenharmony_ci * Cache the b0 value on the first AP that comes up 17862306a36Sopenharmony_ci */ 17962306a36Sopenharmony_ci if (!(fix_bsp_b0 && cpuid)) 18062306a36Sopenharmony_ci return; 18162306a36Sopenharmony_ci 18262306a36Sopenharmony_ci sal_boot_rendez_state[0].br[0] = sal_boot_rendez_state[cpuid].br[0]; 18362306a36Sopenharmony_ci printk ("Fixed BSP b0 value from CPU %d\n", cpuid); 18462306a36Sopenharmony_ci 18562306a36Sopenharmony_ci fix_bsp_b0 = 0; 18662306a36Sopenharmony_ci#endif 18762306a36Sopenharmony_ci} 18862306a36Sopenharmony_ci 18962306a36Sopenharmony_civoid 19062306a36Sopenharmony_cisync_master (void *arg) 19162306a36Sopenharmony_ci{ 19262306a36Sopenharmony_ci unsigned long flags, i; 19362306a36Sopenharmony_ci 19462306a36Sopenharmony_ci go[MASTER] = 0; 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_ci local_irq_save(flags); 19762306a36Sopenharmony_ci { 19862306a36Sopenharmony_ci for (i = 0; i < NUM_ROUNDS*NUM_ITERS; ++i) { 19962306a36Sopenharmony_ci while (!go[MASTER]) 20062306a36Sopenharmony_ci cpu_relax(); 20162306a36Sopenharmony_ci go[MASTER] = 0; 20262306a36Sopenharmony_ci go[SLAVE] = ia64_get_itc(); 20362306a36Sopenharmony_ci } 20462306a36Sopenharmony_ci } 20562306a36Sopenharmony_ci local_irq_restore(flags); 20662306a36Sopenharmony_ci} 20762306a36Sopenharmony_ci 20862306a36Sopenharmony_ci/* 20962306a36Sopenharmony_ci * Return the number of cycles by which our itc differs from the itc on the master 21062306a36Sopenharmony_ci * (time-keeper) CPU. A positive number indicates our itc is ahead of the master, 21162306a36Sopenharmony_ci * negative that it is behind. 21262306a36Sopenharmony_ci */ 21362306a36Sopenharmony_cistatic inline long 21462306a36Sopenharmony_ciget_delta (long *rt, long *master) 21562306a36Sopenharmony_ci{ 21662306a36Sopenharmony_ci unsigned long best_t0 = 0, best_t1 = ~0UL, best_tm = 0; 21762306a36Sopenharmony_ci unsigned long tcenter, t0, t1, tm; 21862306a36Sopenharmony_ci long i; 21962306a36Sopenharmony_ci 22062306a36Sopenharmony_ci for (i = 0; i < NUM_ITERS; ++i) { 22162306a36Sopenharmony_ci t0 = ia64_get_itc(); 22262306a36Sopenharmony_ci go[MASTER] = 1; 22362306a36Sopenharmony_ci while (!(tm = go[SLAVE])) 22462306a36Sopenharmony_ci cpu_relax(); 22562306a36Sopenharmony_ci go[SLAVE] = 0; 22662306a36Sopenharmony_ci t1 = ia64_get_itc(); 22762306a36Sopenharmony_ci 22862306a36Sopenharmony_ci if (t1 - t0 < best_t1 - best_t0) 22962306a36Sopenharmony_ci best_t0 = t0, best_t1 = t1, best_tm = tm; 23062306a36Sopenharmony_ci } 23162306a36Sopenharmony_ci 23262306a36Sopenharmony_ci *rt = best_t1 - best_t0; 23362306a36Sopenharmony_ci *master = best_tm - best_t0; 23462306a36Sopenharmony_ci 23562306a36Sopenharmony_ci /* average best_t0 and best_t1 without overflow: */ 23662306a36Sopenharmony_ci tcenter = (best_t0/2 + best_t1/2); 23762306a36Sopenharmony_ci if (best_t0 % 2 + best_t1 % 2 == 2) 23862306a36Sopenharmony_ci ++tcenter; 23962306a36Sopenharmony_ci return tcenter - best_tm; 24062306a36Sopenharmony_ci} 24162306a36Sopenharmony_ci 24262306a36Sopenharmony_ci/* 24362306a36Sopenharmony_ci * Synchronize ar.itc of the current (slave) CPU with the ar.itc of the MASTER CPU 24462306a36Sopenharmony_ci * (normally the time-keeper CPU). We use a closed loop to eliminate the possibility of 24562306a36Sopenharmony_ci * unaccounted-for errors (such as getting a machine check in the middle of a calibration 24662306a36Sopenharmony_ci * step). The basic idea is for the slave to ask the master what itc value it has and to 24762306a36Sopenharmony_ci * read its own itc before and after the master responds. Each iteration gives us three 24862306a36Sopenharmony_ci * timestamps: 24962306a36Sopenharmony_ci * 25062306a36Sopenharmony_ci * slave master 25162306a36Sopenharmony_ci * 25262306a36Sopenharmony_ci * t0 ---\ 25362306a36Sopenharmony_ci * ---\ 25462306a36Sopenharmony_ci * ---> 25562306a36Sopenharmony_ci * tm 25662306a36Sopenharmony_ci * /--- 25762306a36Sopenharmony_ci * /--- 25862306a36Sopenharmony_ci * t1 <--- 25962306a36Sopenharmony_ci * 26062306a36Sopenharmony_ci * 26162306a36Sopenharmony_ci * The goal is to adjust the slave's ar.itc such that tm falls exactly half-way between t0 26262306a36Sopenharmony_ci * and t1. If we achieve this, the clocks are synchronized provided the interconnect 26362306a36Sopenharmony_ci * between the slave and the master is symmetric. Even if the interconnect were 26462306a36Sopenharmony_ci * asymmetric, we would still know that the synchronization error is smaller than the 26562306a36Sopenharmony_ci * roundtrip latency (t0 - t1). 26662306a36Sopenharmony_ci * 26762306a36Sopenharmony_ci * When the interconnect is quiet and symmetric, this lets us synchronize the itc to 26862306a36Sopenharmony_ci * within one or two cycles. However, we can only *guarantee* that the synchronization is 26962306a36Sopenharmony_ci * accurate to within a round-trip time, which is typically in the range of several 27062306a36Sopenharmony_ci * hundred cycles (e.g., ~500 cycles). In practice, this means that the itc's are usually 27162306a36Sopenharmony_ci * almost perfectly synchronized, but we shouldn't assume that the accuracy is much better 27262306a36Sopenharmony_ci * than half a micro second or so. 27362306a36Sopenharmony_ci */ 27462306a36Sopenharmony_civoid 27562306a36Sopenharmony_ciia64_sync_itc (unsigned int master) 27662306a36Sopenharmony_ci{ 27762306a36Sopenharmony_ci long i, delta, adj, adjust_latency = 0, done = 0; 27862306a36Sopenharmony_ci unsigned long flags, rt, master_time_stamp, bound; 27962306a36Sopenharmony_ci#if DEBUG_ITC_SYNC 28062306a36Sopenharmony_ci struct { 28162306a36Sopenharmony_ci long rt; /* roundtrip time */ 28262306a36Sopenharmony_ci long master; /* master's timestamp */ 28362306a36Sopenharmony_ci long diff; /* difference between midpoint and master's timestamp */ 28462306a36Sopenharmony_ci long lat; /* estimate of itc adjustment latency */ 28562306a36Sopenharmony_ci } t[NUM_ROUNDS]; 28662306a36Sopenharmony_ci#endif 28762306a36Sopenharmony_ci 28862306a36Sopenharmony_ci /* 28962306a36Sopenharmony_ci * Make sure local timer ticks are disabled while we sync. If 29062306a36Sopenharmony_ci * they were enabled, we'd have to worry about nasty issues 29162306a36Sopenharmony_ci * like setting the ITC ahead of (or a long time before) the 29262306a36Sopenharmony_ci * next scheduled tick. 29362306a36Sopenharmony_ci */ 29462306a36Sopenharmony_ci BUG_ON((ia64_get_itv() & (1 << 16)) == 0); 29562306a36Sopenharmony_ci 29662306a36Sopenharmony_ci go[MASTER] = 1; 29762306a36Sopenharmony_ci 29862306a36Sopenharmony_ci if (smp_call_function_single(master, sync_master, NULL, 0) < 0) { 29962306a36Sopenharmony_ci printk(KERN_ERR "sync_itc: failed to get attention of CPU %u!\n", master); 30062306a36Sopenharmony_ci return; 30162306a36Sopenharmony_ci } 30262306a36Sopenharmony_ci 30362306a36Sopenharmony_ci while (go[MASTER]) 30462306a36Sopenharmony_ci cpu_relax(); /* wait for master to be ready */ 30562306a36Sopenharmony_ci 30662306a36Sopenharmony_ci spin_lock_irqsave(&itc_sync_lock, flags); 30762306a36Sopenharmony_ci { 30862306a36Sopenharmony_ci for (i = 0; i < NUM_ROUNDS; ++i) { 30962306a36Sopenharmony_ci delta = get_delta(&rt, &master_time_stamp); 31062306a36Sopenharmony_ci if (delta == 0) { 31162306a36Sopenharmony_ci done = 1; /* let's lock on to this... */ 31262306a36Sopenharmony_ci bound = rt; 31362306a36Sopenharmony_ci } 31462306a36Sopenharmony_ci 31562306a36Sopenharmony_ci if (!done) { 31662306a36Sopenharmony_ci if (i > 0) { 31762306a36Sopenharmony_ci adjust_latency += -delta; 31862306a36Sopenharmony_ci adj = -delta + adjust_latency/4; 31962306a36Sopenharmony_ci } else 32062306a36Sopenharmony_ci adj = -delta; 32162306a36Sopenharmony_ci 32262306a36Sopenharmony_ci ia64_set_itc(ia64_get_itc() + adj); 32362306a36Sopenharmony_ci } 32462306a36Sopenharmony_ci#if DEBUG_ITC_SYNC 32562306a36Sopenharmony_ci t[i].rt = rt; 32662306a36Sopenharmony_ci t[i].master = master_time_stamp; 32762306a36Sopenharmony_ci t[i].diff = delta; 32862306a36Sopenharmony_ci t[i].lat = adjust_latency/4; 32962306a36Sopenharmony_ci#endif 33062306a36Sopenharmony_ci } 33162306a36Sopenharmony_ci } 33262306a36Sopenharmony_ci spin_unlock_irqrestore(&itc_sync_lock, flags); 33362306a36Sopenharmony_ci 33462306a36Sopenharmony_ci#if DEBUG_ITC_SYNC 33562306a36Sopenharmony_ci for (i = 0; i < NUM_ROUNDS; ++i) 33662306a36Sopenharmony_ci printk("rt=%5ld master=%5ld diff=%5ld adjlat=%5ld\n", 33762306a36Sopenharmony_ci t[i].rt, t[i].master, t[i].diff, t[i].lat); 33862306a36Sopenharmony_ci#endif 33962306a36Sopenharmony_ci 34062306a36Sopenharmony_ci printk(KERN_INFO "CPU %d: synchronized ITC with CPU %u (last diff %ld cycles, " 34162306a36Sopenharmony_ci "maxerr %lu cycles)\n", smp_processor_id(), master, delta, rt); 34262306a36Sopenharmony_ci} 34362306a36Sopenharmony_ci 34462306a36Sopenharmony_ci/* 34562306a36Sopenharmony_ci * Ideally sets up per-cpu profiling hooks. Doesn't do much now... 34662306a36Sopenharmony_ci */ 34762306a36Sopenharmony_cistatic inline void smp_setup_percpu_timer(void) 34862306a36Sopenharmony_ci{ 34962306a36Sopenharmony_ci} 35062306a36Sopenharmony_ci 35162306a36Sopenharmony_cistatic void 35262306a36Sopenharmony_cismp_callin (void) 35362306a36Sopenharmony_ci{ 35462306a36Sopenharmony_ci int cpuid, phys_id, itc_master; 35562306a36Sopenharmony_ci struct cpuinfo_ia64 *last_cpuinfo, *this_cpuinfo; 35662306a36Sopenharmony_ci extern void ia64_init_itm(void); 35762306a36Sopenharmony_ci extern volatile int time_keeper_id; 35862306a36Sopenharmony_ci 35962306a36Sopenharmony_ci cpuid = smp_processor_id(); 36062306a36Sopenharmony_ci phys_id = hard_smp_processor_id(); 36162306a36Sopenharmony_ci itc_master = time_keeper_id; 36262306a36Sopenharmony_ci 36362306a36Sopenharmony_ci if (cpu_online(cpuid)) { 36462306a36Sopenharmony_ci printk(KERN_ERR "huh, phys CPU#0x%x, CPU#0x%x already present??\n", 36562306a36Sopenharmony_ci phys_id, cpuid); 36662306a36Sopenharmony_ci BUG(); 36762306a36Sopenharmony_ci } 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_ci fix_b0_for_bsp(); 37062306a36Sopenharmony_ci 37162306a36Sopenharmony_ci /* 37262306a36Sopenharmony_ci * numa_node_id() works after this. 37362306a36Sopenharmony_ci */ 37462306a36Sopenharmony_ci set_numa_node(cpu_to_node_map[cpuid]); 37562306a36Sopenharmony_ci set_numa_mem(local_memory_node(cpu_to_node_map[cpuid])); 37662306a36Sopenharmony_ci 37762306a36Sopenharmony_ci spin_lock(&vector_lock); 37862306a36Sopenharmony_ci /* Setup the per cpu irq handling data structures */ 37962306a36Sopenharmony_ci __setup_vector_irq(cpuid); 38062306a36Sopenharmony_ci notify_cpu_starting(cpuid); 38162306a36Sopenharmony_ci set_cpu_online(cpuid, true); 38262306a36Sopenharmony_ci per_cpu(cpu_state, cpuid) = CPU_ONLINE; 38362306a36Sopenharmony_ci spin_unlock(&vector_lock); 38462306a36Sopenharmony_ci 38562306a36Sopenharmony_ci smp_setup_percpu_timer(); 38662306a36Sopenharmony_ci 38762306a36Sopenharmony_ci ia64_mca_cmc_vector_setup(); /* Setup vector on AP */ 38862306a36Sopenharmony_ci 38962306a36Sopenharmony_ci local_irq_enable(); 39062306a36Sopenharmony_ci 39162306a36Sopenharmony_ci if (!(sal_platform_features & IA64_SAL_PLATFORM_FEATURE_ITC_DRIFT)) { 39262306a36Sopenharmony_ci /* 39362306a36Sopenharmony_ci * Synchronize the ITC with the BP. Need to do this after irqs are 39462306a36Sopenharmony_ci * enabled because ia64_sync_itc() calls smp_call_function_single(), which 39562306a36Sopenharmony_ci * calls spin_unlock_bh(), which calls spin_unlock_bh(), which calls 39662306a36Sopenharmony_ci * local_bh_enable(), which bugs out if irqs are not enabled... 39762306a36Sopenharmony_ci */ 39862306a36Sopenharmony_ci Dprintk("Going to syncup ITC with ITC Master.\n"); 39962306a36Sopenharmony_ci ia64_sync_itc(itc_master); 40062306a36Sopenharmony_ci } 40162306a36Sopenharmony_ci 40262306a36Sopenharmony_ci /* 40362306a36Sopenharmony_ci * Get our bogomips. 40462306a36Sopenharmony_ci */ 40562306a36Sopenharmony_ci ia64_init_itm(); 40662306a36Sopenharmony_ci 40762306a36Sopenharmony_ci /* 40862306a36Sopenharmony_ci * Delay calibration can be skipped if new processor is identical to the 40962306a36Sopenharmony_ci * previous processor. 41062306a36Sopenharmony_ci */ 41162306a36Sopenharmony_ci last_cpuinfo = cpu_data(cpuid - 1); 41262306a36Sopenharmony_ci this_cpuinfo = local_cpu_data; 41362306a36Sopenharmony_ci if (last_cpuinfo->itc_freq != this_cpuinfo->itc_freq || 41462306a36Sopenharmony_ci last_cpuinfo->proc_freq != this_cpuinfo->proc_freq || 41562306a36Sopenharmony_ci last_cpuinfo->features != this_cpuinfo->features || 41662306a36Sopenharmony_ci last_cpuinfo->revision != this_cpuinfo->revision || 41762306a36Sopenharmony_ci last_cpuinfo->family != this_cpuinfo->family || 41862306a36Sopenharmony_ci last_cpuinfo->archrev != this_cpuinfo->archrev || 41962306a36Sopenharmony_ci last_cpuinfo->model != this_cpuinfo->model) 42062306a36Sopenharmony_ci calibrate_delay(); 42162306a36Sopenharmony_ci local_cpu_data->loops_per_jiffy = loops_per_jiffy; 42262306a36Sopenharmony_ci 42362306a36Sopenharmony_ci /* 42462306a36Sopenharmony_ci * Allow the master to continue. 42562306a36Sopenharmony_ci */ 42662306a36Sopenharmony_ci cpumask_set_cpu(cpuid, &cpu_callin_map); 42762306a36Sopenharmony_ci Dprintk("Stack on CPU %d at about %p\n",cpuid, &cpuid); 42862306a36Sopenharmony_ci} 42962306a36Sopenharmony_ci 43062306a36Sopenharmony_ci 43162306a36Sopenharmony_ci/* 43262306a36Sopenharmony_ci * Activate a secondary processor. head.S calls this. 43362306a36Sopenharmony_ci */ 43462306a36Sopenharmony_ciint 43562306a36Sopenharmony_cistart_secondary (void *unused) 43662306a36Sopenharmony_ci{ 43762306a36Sopenharmony_ci /* Early console may use I/O ports */ 43862306a36Sopenharmony_ci ia64_set_kr(IA64_KR_IO_BASE, __pa(ia64_iobase)); 43962306a36Sopenharmony_ci#ifndef CONFIG_PRINTK_TIME 44062306a36Sopenharmony_ci Dprintk("start_secondary: starting CPU 0x%x\n", hard_smp_processor_id()); 44162306a36Sopenharmony_ci#endif 44262306a36Sopenharmony_ci efi_map_pal_code(); 44362306a36Sopenharmony_ci cpu_init(); 44462306a36Sopenharmony_ci smp_callin(); 44562306a36Sopenharmony_ci 44662306a36Sopenharmony_ci cpu_startup_entry(CPUHP_AP_ONLINE_IDLE); 44762306a36Sopenharmony_ci return 0; 44862306a36Sopenharmony_ci} 44962306a36Sopenharmony_ci 45062306a36Sopenharmony_cistatic int 45162306a36Sopenharmony_cido_boot_cpu (int sapicid, int cpu, struct task_struct *idle) 45262306a36Sopenharmony_ci{ 45362306a36Sopenharmony_ci int timeout; 45462306a36Sopenharmony_ci 45562306a36Sopenharmony_ci task_for_booting_cpu = idle; 45662306a36Sopenharmony_ci Dprintk("Sending wakeup vector %lu to AP 0x%x/0x%x.\n", ap_wakeup_vector, cpu, sapicid); 45762306a36Sopenharmony_ci 45862306a36Sopenharmony_ci set_brendez_area(cpu); 45962306a36Sopenharmony_ci ia64_send_ipi(cpu, ap_wakeup_vector, IA64_IPI_DM_INT, 0); 46062306a36Sopenharmony_ci 46162306a36Sopenharmony_ci /* 46262306a36Sopenharmony_ci * Wait 10s total for the AP to start 46362306a36Sopenharmony_ci */ 46462306a36Sopenharmony_ci Dprintk("Waiting on callin_map ..."); 46562306a36Sopenharmony_ci for (timeout = 0; timeout < 100000; timeout++) { 46662306a36Sopenharmony_ci if (cpumask_test_cpu(cpu, &cpu_callin_map)) 46762306a36Sopenharmony_ci break; /* It has booted */ 46862306a36Sopenharmony_ci barrier(); /* Make sure we re-read cpu_callin_map */ 46962306a36Sopenharmony_ci udelay(100); 47062306a36Sopenharmony_ci } 47162306a36Sopenharmony_ci Dprintk("\n"); 47262306a36Sopenharmony_ci 47362306a36Sopenharmony_ci if (!cpumask_test_cpu(cpu, &cpu_callin_map)) { 47462306a36Sopenharmony_ci printk(KERN_ERR "Processor 0x%x/0x%x is stuck.\n", cpu, sapicid); 47562306a36Sopenharmony_ci ia64_cpu_to_sapicid[cpu] = -1; 47662306a36Sopenharmony_ci set_cpu_online(cpu, false); /* was set in smp_callin() */ 47762306a36Sopenharmony_ci return -EINVAL; 47862306a36Sopenharmony_ci } 47962306a36Sopenharmony_ci return 0; 48062306a36Sopenharmony_ci} 48162306a36Sopenharmony_ci 48262306a36Sopenharmony_cistatic int __init 48362306a36Sopenharmony_cidecay (char *str) 48462306a36Sopenharmony_ci{ 48562306a36Sopenharmony_ci int ticks; 48662306a36Sopenharmony_ci get_option (&str, &ticks); 48762306a36Sopenharmony_ci return 1; 48862306a36Sopenharmony_ci} 48962306a36Sopenharmony_ci 49062306a36Sopenharmony_ci__setup("decay=", decay); 49162306a36Sopenharmony_ci 49262306a36Sopenharmony_ci/* 49362306a36Sopenharmony_ci * Initialize the logical CPU number to SAPICID mapping 49462306a36Sopenharmony_ci */ 49562306a36Sopenharmony_civoid __init 49662306a36Sopenharmony_cismp_build_cpu_map (void) 49762306a36Sopenharmony_ci{ 49862306a36Sopenharmony_ci int sapicid, cpu, i; 49962306a36Sopenharmony_ci int boot_cpu_id = hard_smp_processor_id(); 50062306a36Sopenharmony_ci 50162306a36Sopenharmony_ci for (cpu = 0; cpu < NR_CPUS; cpu++) { 50262306a36Sopenharmony_ci ia64_cpu_to_sapicid[cpu] = -1; 50362306a36Sopenharmony_ci } 50462306a36Sopenharmony_ci 50562306a36Sopenharmony_ci ia64_cpu_to_sapicid[0] = boot_cpu_id; 50662306a36Sopenharmony_ci init_cpu_present(cpumask_of(0)); 50762306a36Sopenharmony_ci set_cpu_possible(0, true); 50862306a36Sopenharmony_ci for (cpu = 1, i = 0; i < smp_boot_data.cpu_count; i++) { 50962306a36Sopenharmony_ci sapicid = smp_boot_data.cpu_phys_id[i]; 51062306a36Sopenharmony_ci if (sapicid == boot_cpu_id) 51162306a36Sopenharmony_ci continue; 51262306a36Sopenharmony_ci set_cpu_present(cpu, true); 51362306a36Sopenharmony_ci set_cpu_possible(cpu, true); 51462306a36Sopenharmony_ci ia64_cpu_to_sapicid[cpu] = sapicid; 51562306a36Sopenharmony_ci cpu++; 51662306a36Sopenharmony_ci } 51762306a36Sopenharmony_ci} 51862306a36Sopenharmony_ci 51962306a36Sopenharmony_ci/* 52062306a36Sopenharmony_ci * Cycle through the APs sending Wakeup IPIs to boot each. 52162306a36Sopenharmony_ci */ 52262306a36Sopenharmony_civoid __init 52362306a36Sopenharmony_cismp_prepare_cpus (unsigned int max_cpus) 52462306a36Sopenharmony_ci{ 52562306a36Sopenharmony_ci int boot_cpu_id = hard_smp_processor_id(); 52662306a36Sopenharmony_ci 52762306a36Sopenharmony_ci /* 52862306a36Sopenharmony_ci * Initialize the per-CPU profiling counter/multiplier 52962306a36Sopenharmony_ci */ 53062306a36Sopenharmony_ci 53162306a36Sopenharmony_ci smp_setup_percpu_timer(); 53262306a36Sopenharmony_ci 53362306a36Sopenharmony_ci cpumask_set_cpu(0, &cpu_callin_map); 53462306a36Sopenharmony_ci 53562306a36Sopenharmony_ci local_cpu_data->loops_per_jiffy = loops_per_jiffy; 53662306a36Sopenharmony_ci ia64_cpu_to_sapicid[0] = boot_cpu_id; 53762306a36Sopenharmony_ci 53862306a36Sopenharmony_ci printk(KERN_INFO "Boot processor id 0x%x/0x%x\n", 0, boot_cpu_id); 53962306a36Sopenharmony_ci 54062306a36Sopenharmony_ci current_thread_info()->cpu = 0; 54162306a36Sopenharmony_ci 54262306a36Sopenharmony_ci /* 54362306a36Sopenharmony_ci * If SMP should be disabled, then really disable it! 54462306a36Sopenharmony_ci */ 54562306a36Sopenharmony_ci if (!max_cpus) { 54662306a36Sopenharmony_ci printk(KERN_INFO "SMP mode deactivated.\n"); 54762306a36Sopenharmony_ci init_cpu_online(cpumask_of(0)); 54862306a36Sopenharmony_ci init_cpu_present(cpumask_of(0)); 54962306a36Sopenharmony_ci init_cpu_possible(cpumask_of(0)); 55062306a36Sopenharmony_ci return; 55162306a36Sopenharmony_ci } 55262306a36Sopenharmony_ci} 55362306a36Sopenharmony_ci 55462306a36Sopenharmony_civoid smp_prepare_boot_cpu(void) 55562306a36Sopenharmony_ci{ 55662306a36Sopenharmony_ci set_cpu_online(smp_processor_id(), true); 55762306a36Sopenharmony_ci cpumask_set_cpu(smp_processor_id(), &cpu_callin_map); 55862306a36Sopenharmony_ci set_numa_node(cpu_to_node_map[smp_processor_id()]); 55962306a36Sopenharmony_ci per_cpu(cpu_state, smp_processor_id()) = CPU_ONLINE; 56062306a36Sopenharmony_ci} 56162306a36Sopenharmony_ci 56262306a36Sopenharmony_ci#ifdef CONFIG_HOTPLUG_CPU 56362306a36Sopenharmony_cistatic inline void 56462306a36Sopenharmony_ciclear_cpu_sibling_map(int cpu) 56562306a36Sopenharmony_ci{ 56662306a36Sopenharmony_ci int i; 56762306a36Sopenharmony_ci 56862306a36Sopenharmony_ci for_each_cpu(i, &per_cpu(cpu_sibling_map, cpu)) 56962306a36Sopenharmony_ci cpumask_clear_cpu(cpu, &per_cpu(cpu_sibling_map, i)); 57062306a36Sopenharmony_ci for_each_cpu(i, &cpu_core_map[cpu]) 57162306a36Sopenharmony_ci cpumask_clear_cpu(cpu, &cpu_core_map[i]); 57262306a36Sopenharmony_ci 57362306a36Sopenharmony_ci per_cpu(cpu_sibling_map, cpu) = cpu_core_map[cpu] = CPU_MASK_NONE; 57462306a36Sopenharmony_ci} 57562306a36Sopenharmony_ci 57662306a36Sopenharmony_cistatic void 57762306a36Sopenharmony_ciremove_siblinginfo(int cpu) 57862306a36Sopenharmony_ci{ 57962306a36Sopenharmony_ci if (cpu_data(cpu)->threads_per_core == 1 && 58062306a36Sopenharmony_ci cpu_data(cpu)->cores_per_socket == 1) { 58162306a36Sopenharmony_ci cpumask_clear_cpu(cpu, &cpu_core_map[cpu]); 58262306a36Sopenharmony_ci cpumask_clear_cpu(cpu, &per_cpu(cpu_sibling_map, cpu)); 58362306a36Sopenharmony_ci return; 58462306a36Sopenharmony_ci } 58562306a36Sopenharmony_ci 58662306a36Sopenharmony_ci /* remove it from all sibling map's */ 58762306a36Sopenharmony_ci clear_cpu_sibling_map(cpu); 58862306a36Sopenharmony_ci} 58962306a36Sopenharmony_ci 59062306a36Sopenharmony_ciextern void fixup_irqs(void); 59162306a36Sopenharmony_ci 59262306a36Sopenharmony_ciint migrate_platform_irqs(unsigned int cpu) 59362306a36Sopenharmony_ci{ 59462306a36Sopenharmony_ci int new_cpei_cpu; 59562306a36Sopenharmony_ci struct irq_data *data = NULL; 59662306a36Sopenharmony_ci const struct cpumask *mask; 59762306a36Sopenharmony_ci int retval = 0; 59862306a36Sopenharmony_ci 59962306a36Sopenharmony_ci /* 60062306a36Sopenharmony_ci * dont permit CPEI target to removed. 60162306a36Sopenharmony_ci */ 60262306a36Sopenharmony_ci if (cpe_vector > 0 && is_cpu_cpei_target(cpu)) { 60362306a36Sopenharmony_ci printk ("CPU (%d) is CPEI Target\n", cpu); 60462306a36Sopenharmony_ci if (can_cpei_retarget()) { 60562306a36Sopenharmony_ci /* 60662306a36Sopenharmony_ci * Now re-target the CPEI to a different processor 60762306a36Sopenharmony_ci */ 60862306a36Sopenharmony_ci new_cpei_cpu = cpumask_any(cpu_online_mask); 60962306a36Sopenharmony_ci mask = cpumask_of(new_cpei_cpu); 61062306a36Sopenharmony_ci set_cpei_target_cpu(new_cpei_cpu); 61162306a36Sopenharmony_ci data = irq_get_irq_data(ia64_cpe_irq); 61262306a36Sopenharmony_ci /* 61362306a36Sopenharmony_ci * Switch for now, immediately, we need to do fake intr 61462306a36Sopenharmony_ci * as other interrupts, but need to study CPEI behaviour with 61562306a36Sopenharmony_ci * polling before making changes. 61662306a36Sopenharmony_ci */ 61762306a36Sopenharmony_ci if (data && data->chip) { 61862306a36Sopenharmony_ci data->chip->irq_disable(data); 61962306a36Sopenharmony_ci data->chip->irq_set_affinity(data, mask, false); 62062306a36Sopenharmony_ci data->chip->irq_enable(data); 62162306a36Sopenharmony_ci printk ("Re-targeting CPEI to cpu %d\n", new_cpei_cpu); 62262306a36Sopenharmony_ci } 62362306a36Sopenharmony_ci } 62462306a36Sopenharmony_ci if (!data) { 62562306a36Sopenharmony_ci printk ("Unable to retarget CPEI, offline cpu [%d] failed\n", cpu); 62662306a36Sopenharmony_ci retval = -EBUSY; 62762306a36Sopenharmony_ci } 62862306a36Sopenharmony_ci } 62962306a36Sopenharmony_ci return retval; 63062306a36Sopenharmony_ci} 63162306a36Sopenharmony_ci 63262306a36Sopenharmony_ci/* must be called with cpucontrol mutex held */ 63362306a36Sopenharmony_ciint __cpu_disable(void) 63462306a36Sopenharmony_ci{ 63562306a36Sopenharmony_ci int cpu = smp_processor_id(); 63662306a36Sopenharmony_ci 63762306a36Sopenharmony_ci /* 63862306a36Sopenharmony_ci * dont permit boot processor for now 63962306a36Sopenharmony_ci */ 64062306a36Sopenharmony_ci if (cpu == 0 && !bsp_remove_ok) { 64162306a36Sopenharmony_ci printk ("Your platform does not support removal of BSP\n"); 64262306a36Sopenharmony_ci return (-EBUSY); 64362306a36Sopenharmony_ci } 64462306a36Sopenharmony_ci 64562306a36Sopenharmony_ci set_cpu_online(cpu, false); 64662306a36Sopenharmony_ci 64762306a36Sopenharmony_ci if (migrate_platform_irqs(cpu)) { 64862306a36Sopenharmony_ci set_cpu_online(cpu, true); 64962306a36Sopenharmony_ci return -EBUSY; 65062306a36Sopenharmony_ci } 65162306a36Sopenharmony_ci 65262306a36Sopenharmony_ci remove_siblinginfo(cpu); 65362306a36Sopenharmony_ci fixup_irqs(); 65462306a36Sopenharmony_ci local_flush_tlb_all(); 65562306a36Sopenharmony_ci cpumask_clear_cpu(cpu, &cpu_callin_map); 65662306a36Sopenharmony_ci return 0; 65762306a36Sopenharmony_ci} 65862306a36Sopenharmony_ci 65962306a36Sopenharmony_civoid __cpu_die(unsigned int cpu) 66062306a36Sopenharmony_ci{ 66162306a36Sopenharmony_ci unsigned int i; 66262306a36Sopenharmony_ci 66362306a36Sopenharmony_ci for (i = 0; i < 100; i++) { 66462306a36Sopenharmony_ci /* They ack this in play_dead by setting CPU_DEAD */ 66562306a36Sopenharmony_ci if (per_cpu(cpu_state, cpu) == CPU_DEAD) 66662306a36Sopenharmony_ci { 66762306a36Sopenharmony_ci printk ("CPU %d is now offline\n", cpu); 66862306a36Sopenharmony_ci return; 66962306a36Sopenharmony_ci } 67062306a36Sopenharmony_ci msleep(100); 67162306a36Sopenharmony_ci } 67262306a36Sopenharmony_ci printk(KERN_ERR "CPU %u didn't die...\n", cpu); 67362306a36Sopenharmony_ci} 67462306a36Sopenharmony_ci#endif /* CONFIG_HOTPLUG_CPU */ 67562306a36Sopenharmony_ci 67662306a36Sopenharmony_civoid 67762306a36Sopenharmony_cismp_cpus_done (unsigned int dummy) 67862306a36Sopenharmony_ci{ 67962306a36Sopenharmony_ci int cpu; 68062306a36Sopenharmony_ci unsigned long bogosum = 0; 68162306a36Sopenharmony_ci 68262306a36Sopenharmony_ci /* 68362306a36Sopenharmony_ci * Allow the user to impress friends. 68462306a36Sopenharmony_ci */ 68562306a36Sopenharmony_ci 68662306a36Sopenharmony_ci for_each_online_cpu(cpu) { 68762306a36Sopenharmony_ci bogosum += cpu_data(cpu)->loops_per_jiffy; 68862306a36Sopenharmony_ci } 68962306a36Sopenharmony_ci 69062306a36Sopenharmony_ci printk(KERN_INFO "Total of %d processors activated (%lu.%02lu BogoMIPS).\n", 69162306a36Sopenharmony_ci (int)num_online_cpus(), bogosum/(500000/HZ), (bogosum/(5000/HZ))%100); 69262306a36Sopenharmony_ci} 69362306a36Sopenharmony_ci 69462306a36Sopenharmony_cistatic inline void set_cpu_sibling_map(int cpu) 69562306a36Sopenharmony_ci{ 69662306a36Sopenharmony_ci int i; 69762306a36Sopenharmony_ci 69862306a36Sopenharmony_ci for_each_online_cpu(i) { 69962306a36Sopenharmony_ci if ((cpu_data(cpu)->socket_id == cpu_data(i)->socket_id)) { 70062306a36Sopenharmony_ci cpumask_set_cpu(i, &cpu_core_map[cpu]); 70162306a36Sopenharmony_ci cpumask_set_cpu(cpu, &cpu_core_map[i]); 70262306a36Sopenharmony_ci if (cpu_data(cpu)->core_id == cpu_data(i)->core_id) { 70362306a36Sopenharmony_ci cpumask_set_cpu(i, 70462306a36Sopenharmony_ci &per_cpu(cpu_sibling_map, cpu)); 70562306a36Sopenharmony_ci cpumask_set_cpu(cpu, 70662306a36Sopenharmony_ci &per_cpu(cpu_sibling_map, i)); 70762306a36Sopenharmony_ci } 70862306a36Sopenharmony_ci } 70962306a36Sopenharmony_ci } 71062306a36Sopenharmony_ci} 71162306a36Sopenharmony_ci 71262306a36Sopenharmony_ciint 71362306a36Sopenharmony_ci__cpu_up(unsigned int cpu, struct task_struct *tidle) 71462306a36Sopenharmony_ci{ 71562306a36Sopenharmony_ci int ret; 71662306a36Sopenharmony_ci int sapicid; 71762306a36Sopenharmony_ci 71862306a36Sopenharmony_ci sapicid = ia64_cpu_to_sapicid[cpu]; 71962306a36Sopenharmony_ci if (sapicid == -1) 72062306a36Sopenharmony_ci return -EINVAL; 72162306a36Sopenharmony_ci 72262306a36Sopenharmony_ci /* 72362306a36Sopenharmony_ci * Already booted cpu? not valid anymore since we dont 72462306a36Sopenharmony_ci * do idle loop tightspin anymore. 72562306a36Sopenharmony_ci */ 72662306a36Sopenharmony_ci if (cpumask_test_cpu(cpu, &cpu_callin_map)) 72762306a36Sopenharmony_ci return -EINVAL; 72862306a36Sopenharmony_ci 72962306a36Sopenharmony_ci per_cpu(cpu_state, cpu) = CPU_UP_PREPARE; 73062306a36Sopenharmony_ci /* Processor goes to start_secondary(), sets online flag */ 73162306a36Sopenharmony_ci ret = do_boot_cpu(sapicid, cpu, tidle); 73262306a36Sopenharmony_ci if (ret < 0) 73362306a36Sopenharmony_ci return ret; 73462306a36Sopenharmony_ci 73562306a36Sopenharmony_ci if (cpu_data(cpu)->threads_per_core == 1 && 73662306a36Sopenharmony_ci cpu_data(cpu)->cores_per_socket == 1) { 73762306a36Sopenharmony_ci cpumask_set_cpu(cpu, &per_cpu(cpu_sibling_map, cpu)); 73862306a36Sopenharmony_ci cpumask_set_cpu(cpu, &cpu_core_map[cpu]); 73962306a36Sopenharmony_ci return 0; 74062306a36Sopenharmony_ci } 74162306a36Sopenharmony_ci 74262306a36Sopenharmony_ci set_cpu_sibling_map(cpu); 74362306a36Sopenharmony_ci 74462306a36Sopenharmony_ci return 0; 74562306a36Sopenharmony_ci} 74662306a36Sopenharmony_ci 74762306a36Sopenharmony_ci/* 74862306a36Sopenharmony_ci * Assume that CPUs have been discovered by some platform-dependent interface. For 74962306a36Sopenharmony_ci * SoftSDV/Lion, that would be ACPI. 75062306a36Sopenharmony_ci * 75162306a36Sopenharmony_ci * Setup of the IPI irq handler is done in irq.c:init_IRQ_SMP(). 75262306a36Sopenharmony_ci */ 75362306a36Sopenharmony_civoid __init 75462306a36Sopenharmony_ciinit_smp_config(void) 75562306a36Sopenharmony_ci{ 75662306a36Sopenharmony_ci struct fptr { 75762306a36Sopenharmony_ci unsigned long fp; 75862306a36Sopenharmony_ci unsigned long gp; 75962306a36Sopenharmony_ci } *ap_startup; 76062306a36Sopenharmony_ci long sal_ret; 76162306a36Sopenharmony_ci 76262306a36Sopenharmony_ci /* Tell SAL where to drop the APs. */ 76362306a36Sopenharmony_ci ap_startup = (struct fptr *) start_ap; 76462306a36Sopenharmony_ci sal_ret = ia64_sal_set_vectors(SAL_VECTOR_OS_BOOT_RENDEZ, 76562306a36Sopenharmony_ci ia64_tpa(ap_startup->fp), ia64_tpa(ap_startup->gp), 0, 0, 0, 0); 76662306a36Sopenharmony_ci if (sal_ret < 0) 76762306a36Sopenharmony_ci printk(KERN_ERR "SMP: Can't set SAL AP Boot Rendezvous: %s\n", 76862306a36Sopenharmony_ci ia64_sal_strerror(sal_ret)); 76962306a36Sopenharmony_ci} 77062306a36Sopenharmony_ci 77162306a36Sopenharmony_ci/* 77262306a36Sopenharmony_ci * identify_siblings(cpu) gets called from identify_cpu. This populates the 77362306a36Sopenharmony_ci * information related to logical execution units in per_cpu_data structure. 77462306a36Sopenharmony_ci */ 77562306a36Sopenharmony_civoid identify_siblings(struct cpuinfo_ia64 *c) 77662306a36Sopenharmony_ci{ 77762306a36Sopenharmony_ci long status; 77862306a36Sopenharmony_ci u16 pltid; 77962306a36Sopenharmony_ci pal_logical_to_physical_t info; 78062306a36Sopenharmony_ci 78162306a36Sopenharmony_ci status = ia64_pal_logical_to_phys(-1, &info); 78262306a36Sopenharmony_ci if (status != PAL_STATUS_SUCCESS) { 78362306a36Sopenharmony_ci if (status != PAL_STATUS_UNIMPLEMENTED) { 78462306a36Sopenharmony_ci printk(KERN_ERR 78562306a36Sopenharmony_ci "ia64_pal_logical_to_phys failed with %ld\n", 78662306a36Sopenharmony_ci status); 78762306a36Sopenharmony_ci return; 78862306a36Sopenharmony_ci } 78962306a36Sopenharmony_ci 79062306a36Sopenharmony_ci info.overview_ppid = 0; 79162306a36Sopenharmony_ci info.overview_cpp = 1; 79262306a36Sopenharmony_ci info.overview_tpc = 1; 79362306a36Sopenharmony_ci } 79462306a36Sopenharmony_ci 79562306a36Sopenharmony_ci status = ia64_sal_physical_id_info(&pltid); 79662306a36Sopenharmony_ci if (status != PAL_STATUS_SUCCESS) { 79762306a36Sopenharmony_ci if (status != PAL_STATUS_UNIMPLEMENTED) 79862306a36Sopenharmony_ci printk(KERN_ERR 79962306a36Sopenharmony_ci "ia64_sal_pltid failed with %ld\n", 80062306a36Sopenharmony_ci status); 80162306a36Sopenharmony_ci return; 80262306a36Sopenharmony_ci } 80362306a36Sopenharmony_ci 80462306a36Sopenharmony_ci c->socket_id = (pltid << 8) | info.overview_ppid; 80562306a36Sopenharmony_ci 80662306a36Sopenharmony_ci if (info.overview_cpp == 1 && info.overview_tpc == 1) 80762306a36Sopenharmony_ci return; 80862306a36Sopenharmony_ci 80962306a36Sopenharmony_ci c->cores_per_socket = info.overview_cpp; 81062306a36Sopenharmony_ci c->threads_per_core = info.overview_tpc; 81162306a36Sopenharmony_ci c->num_log = info.overview_num_log; 81262306a36Sopenharmony_ci 81362306a36Sopenharmony_ci c->core_id = info.log1_cid; 81462306a36Sopenharmony_ci c->thread_id = info.log1_tid; 81562306a36Sopenharmony_ci} 81662306a36Sopenharmony_ci 81762306a36Sopenharmony_ci/* 81862306a36Sopenharmony_ci * returns non zero, if multi-threading is enabled 81962306a36Sopenharmony_ci * on at least one physical package. Due to hotplug cpu 82062306a36Sopenharmony_ci * and (maxcpus=), all threads may not necessarily be enabled 82162306a36Sopenharmony_ci * even though the processor supports multi-threading. 82262306a36Sopenharmony_ci */ 82362306a36Sopenharmony_ciint is_multithreading_enabled(void) 82462306a36Sopenharmony_ci{ 82562306a36Sopenharmony_ci int i, j; 82662306a36Sopenharmony_ci 82762306a36Sopenharmony_ci for_each_present_cpu(i) { 82862306a36Sopenharmony_ci for_each_present_cpu(j) { 82962306a36Sopenharmony_ci if (j == i) 83062306a36Sopenharmony_ci continue; 83162306a36Sopenharmony_ci if ((cpu_data(j)->socket_id == cpu_data(i)->socket_id)) { 83262306a36Sopenharmony_ci if (cpu_data(j)->core_id == cpu_data(i)->core_id) 83362306a36Sopenharmony_ci return 1; 83462306a36Sopenharmony_ci } 83562306a36Sopenharmony_ci } 83662306a36Sopenharmony_ci } 83762306a36Sopenharmony_ci return 0; 83862306a36Sopenharmony_ci} 83962306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(is_multithreading_enabled); 840