blob: 3ea872890da219cf6cea900dccdf444a003e35d8 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * arch/s390/kernel/smp.c
3 *
Hans-Joachim Picht155af2f2009-06-16 10:30:52 +02004 * Copyright IBM Corp. 1999, 2009
Linus Torvalds1da177e2005-04-16 15:20:36 -07005 * Author(s): Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com),
Heiko Carstens39ce0102007-04-27 16:02:00 +02006 * Martin Schwidefsky (schwidefsky@de.ibm.com)
7 * Heiko Carstens (heiko.carstens@de.ibm.com)
Linus Torvalds1da177e2005-04-16 15:20:36 -07008 *
Heiko Carstens39ce0102007-04-27 16:02:00 +02009 * based on other smp stuff by
Linus Torvalds1da177e2005-04-16 15:20:36 -070010 * (c) 1995 Alan Cox, CymruNET Ltd <alan@cymru.net>
11 * (c) 1998 Ingo Molnar
12 *
13 * We work with logical cpu numbering everywhere we can. The only
14 * functions using the real cpu address (got from STAP) are the sigp
15 * functions. For all other functions we use the identity mapping.
16 * That means that cpu_number_map[i] == i for every cpu. cpu_number_map is
17 * used e.g. to find the idle task belonging to a logical cpu. Every array
18 * in the kernel is sorted by the logical cpu number and not by the physical
19 * one which is causing all the confusion with __cpu_logical_map and
20 * cpu_number_map in other architectures.
21 */
22
Martin Schwidefsky395d31d2008-12-25 13:39:50 +010023#define KMSG_COMPONENT "cpu"
24#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
25
Heiko Carstensf2308862011-01-05 12:48:08 +010026#include <linux/workqueue.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <linux/module.h>
28#include <linux/init.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070029#include <linux/mm.h>
Alexey Dobriyan4e950f62007-07-30 02:36:13 +040030#include <linux/err.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070031#include <linux/spinlock.h>
32#include <linux/kernel_stat.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033#include <linux/delay.h>
34#include <linux/cache.h>
35#include <linux/interrupt.h>
Christian Borntraeger3324e602009-03-26 15:23:56 +010036#include <linux/irqflags.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070037#include <linux/cpu.h>
Heiko Carstens2b67fc42007-02-05 21:16:47 +010038#include <linux/timex.h>
Michael Holzheu411ed322007-04-27 16:01:49 +020039#include <linux/bootmem.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090040#include <linux/slab.h>
Michael Holzheu60a0c682011-10-30 15:16:40 +010041#include <linux/crash_dump.h>
Heiko Carstenscbb870c2010-02-26 22:37:43 +010042#include <asm/asm-offsets.h>
Michael Holzheu46b05d22007-02-21 10:55:21 +010043#include <asm/ipl.h>
Heiko Carstens2b67fc42007-02-05 21:16:47 +010044#include <asm/setup.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070045#include <asm/sigp.h>
46#include <asm/pgalloc.h>
47#include <asm/irq.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070048#include <asm/cpcmd.h>
49#include <asm/tlbflush.h>
Heiko Carstens2b67fc42007-02-05 21:16:47 +010050#include <asm/timer.h>
Michael Holzheu411ed322007-04-27 16:01:49 +020051#include <asm/lowcore.h>
Heiko Carstens08d07962008-01-26 14:10:56 +010052#include <asm/sclp.h>
Martin Schwidefsky76d4e002009-06-12 10:26:21 +020053#include <asm/cputime.h>
Martin Schwidefskyc742b312008-12-31 15:11:42 +010054#include <asm/vdso.h>
Heiko Carstens4bb5e072009-09-11 10:29:03 +020055#include <asm/cpu.h>
Heiko Carstensa8061702008-04-17 07:46:26 +020056#include "entry.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070057
Heiko Carstensfb380aa2010-01-13 20:44:37 +010058/* logical cpu to cpu address */
Heiko Carstensa93b8ec2010-02-26 22:37:35 +010059unsigned short __cpu_logical_map[NR_CPUS];
Heiko Carstensfb380aa2010-01-13 20:44:37 +010060
Linus Torvalds1da177e2005-04-16 15:20:36 -070061static struct task_struct *current_set[NR_CPUS];
62
Heiko Carstens08d07962008-01-26 14:10:56 +010063static u8 smp_cpu_type;
64static int smp_use_sigp_detection;
65
66enum s390_cpu_state {
67 CPU_STATE_STANDBY,
68 CPU_STATE_CONFIGURED,
69};
70
Heiko Carstensdbd70fb2008-04-17 07:46:12 +020071DEFINE_MUTEX(smp_cpu_state_mutex);
Heiko Carstensc10fde02008-04-17 07:46:13 +020072int smp_cpu_polarization[NR_CPUS];
Heiko Carstens08d07962008-01-26 14:10:56 +010073static int smp_cpu_state[NR_CPUS];
Heiko Carstensc10fde02008-04-17 07:46:13 +020074static int cpu_management;
Heiko Carstens08d07962008-01-26 14:10:56 +010075
76static DEFINE_PER_CPU(struct cpu, cpu_devices);
Heiko Carstens08d07962008-01-26 14:10:56 +010077
Heiko Carstensa93b8ec2010-02-26 22:37:35 +010078static void smp_ext_bitcall(int, int);
Linus Torvalds1da177e2005-04-16 15:20:36 -070079
Heiko Carstensa93b8ec2010-02-26 22:37:35 +010080static int raw_cpu_stopped(int cpu)
Heiko Carstens5c0b9122009-09-11 10:29:05 +020081{
Heiko Carstensa93b8ec2010-02-26 22:37:35 +010082 u32 status;
Heiko Carstens5c0b9122009-09-11 10:29:05 +020083
Heiko Carstensa93b8ec2010-02-26 22:37:35 +010084 switch (raw_sigp_ps(&status, 0, cpu, sigp_sense)) {
Heiko Carstens5c0b9122009-09-11 10:29:05 +020085 case sigp_status_stored:
86 /* Check for stopped and check stop state */
87 if (status & 0x50)
88 return 1;
89 break;
90 default:
91 break;
92 }
93 return 0;
94}
95
Heiko Carstensa93b8ec2010-02-26 22:37:35 +010096static inline int cpu_stopped(int cpu)
97{
98 return raw_cpu_stopped(cpu_logical_map(cpu));
99}
100
Michael Holzheu1943f532011-10-30 15:16:38 +0100101/*
102 * Ensure that PSW restart is done on an online CPU
103 */
104void smp_restart_with_online_cpu(void)
105{
106 int cpu;
107
108 for_each_online_cpu(cpu) {
109 if (stap() == __cpu_logical_map[cpu]) {
110 /* We are online: Enable DAT again and return */
Martin Schwidefskyb50511e2011-10-30 15:16:50 +0100111 __load_psw_mask(psw_kernel_bits | PSW_MASK_DAT);
Michael Holzheu1943f532011-10-30 15:16:38 +0100112 return;
113 }
114 }
115 /* We are not online: Do PSW restart on an online CPU */
116 while (sigp(cpu, sigp_restart) == sigp_busy)
117 cpu_relax();
118 /* And stop ourself */
119 while (raw_sigp(stap(), sigp_stop) == sigp_busy)
120 cpu_relax();
121 for (;;);
122}
123
Heiko Carstens2c2df112010-02-26 22:37:34 +0100124void smp_switch_to_ipl_cpu(void (*func)(void *), void *data)
125{
126 struct _lowcore *lc, *current_lc;
127 struct stack_frame *sf;
128 struct pt_regs *regs;
129 unsigned long sp;
130
131 if (smp_processor_id() == 0)
132 func(data);
Martin Schwidefskyb50511e2011-10-30 15:16:50 +0100133 __load_psw_mask(PSW_DEFAULT_KEY | PSW_MASK_BASE |
134 PSW_MASK_EA | PSW_MASK_BA);
Heiko Carstens2c2df112010-02-26 22:37:34 +0100135 /* Disable lowcore protection */
136 __ctl_clear_bit(0, 28);
137 current_lc = lowcore_ptr[smp_processor_id()];
138 lc = lowcore_ptr[0];
139 if (!lc)
140 lc = current_lc;
Martin Schwidefskyb50511e2011-10-30 15:16:50 +0100141 lc->restart_psw.mask =
142 PSW_DEFAULT_KEY | PSW_MASK_BASE | PSW_MASK_EA | PSW_MASK_BA;
Heiko Carstens2c2df112010-02-26 22:37:34 +0100143 lc->restart_psw.addr = PSW_ADDR_AMODE | (unsigned long) smp_restart_cpu;
144 if (!cpu_online(0))
145 smp_switch_to_cpu(func, data, 0, stap(), __cpu_logical_map[0]);
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100146 while (sigp(0, sigp_stop_and_store_status) == sigp_busy)
Heiko Carstens2c2df112010-02-26 22:37:34 +0100147 cpu_relax();
148 sp = lc->panic_stack;
149 sp -= sizeof(struct pt_regs);
150 regs = (struct pt_regs *) sp;
151 memcpy(&regs->gprs, &current_lc->gpregs_save_area, sizeof(regs->gprs));
Heiko Carstenscbb870c2010-02-26 22:37:43 +0100152 regs->psw = lc->psw_save_area;
Heiko Carstens2c2df112010-02-26 22:37:34 +0100153 sp -= STACK_FRAME_OVERHEAD;
154 sf = (struct stack_frame *) sp;
155 sf->back_chain = regs->gprs[15];
156 smp_switch_to_cpu(func, data, sp, stap(), __cpu_logical_map[0]);
157}
158
Heiko Carstens677d7622007-11-20 11:13:37 +0100159void smp_send_stop(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160{
Heiko Carstens39ce0102007-04-27 16:02:00 +0200161 int cpu, rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162
Heiko Carstens677d7622007-11-20 11:13:37 +0100163 /* Disable all interrupts/machine checks */
Martin Schwidefskyb50511e2011-10-30 15:16:50 +0100164 __load_psw_mask(psw_kernel_bits | PSW_MASK_DAT);
Christian Borntraeger3324e602009-03-26 15:23:56 +0100165 trace_hardirqs_off();
Heiko Carstens677d7622007-11-20 11:13:37 +0100166
Heiko Carstens39ce0102007-04-27 16:02:00 +0200167 /* stop all processors */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700168 for_each_online_cpu(cpu) {
169 if (cpu == smp_processor_id())
170 continue;
171 do {
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100172 rc = sigp(cpu, sigp_stop);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700173 } while (rc == sigp_busy);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700174
Heiko Carstens5c0b9122009-09-11 10:29:05 +0200175 while (!cpu_stopped(cpu))
Heiko Carstensc6b5b842006-12-04 15:40:33 +0100176 cpu_relax();
177 }
178}
179
Linus Torvalds1da177e2005-04-16 15:20:36 -0700180/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700181 * This is the main routine where commands issued by other
182 * cpus are handled.
183 */
184
Martin Schwidefskyf6649a72010-10-25 16:10:38 +0200185static void do_ext_call_interrupt(unsigned int ext_int_code,
186 unsigned int param32, unsigned long param64)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187{
Heiko Carstens39ce0102007-04-27 16:02:00 +0200188 unsigned long bits;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189
Heiko Carstens2a3a2d62011-10-30 15:17:19 +0100190 if (ext_int_code == 0x1202)
191 kstat_cpu(smp_processor_id()).irqs[EXTINT_EXC]++;
192 else
193 kstat_cpu(smp_processor_id()).irqs[EXTINT_EMS]++;
Heiko Carstens39ce0102007-04-27 16:02:00 +0200194 /*
195 * handle bit signal external calls
Heiko Carstens39ce0102007-04-27 16:02:00 +0200196 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197 bits = xchg(&S390_lowcore.ext_call_fast, 0);
198
Peter Zijlstra184748c2011-04-05 17:23:39 +0200199 if (test_bit(ec_schedule, &bits))
200 scheduler_ipi();
201
Heiko Carstens39ce0102007-04-27 16:02:00 +0200202 if (test_bit(ec_call_function, &bits))
Heiko Carstensca9fc752008-12-25 13:38:39 +0100203 generic_smp_call_function_interrupt();
204
205 if (test_bit(ec_call_function_single, &bits))
206 generic_smp_call_function_single_interrupt();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700207}
208
209/*
210 * Send an external call sigp to another cpu and return without waiting
211 * for its completion.
212 */
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100213static void smp_ext_bitcall(int cpu, int sig)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214{
Martin Schwidefskyd98e19c2011-10-30 15:16:58 +0100215 int order;
216
Heiko Carstens39ce0102007-04-27 16:02:00 +0200217 /*
218 * Set signaling bit in lowcore of target cpu and kick it
219 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700220 set_bit(sig, (unsigned long *) &lowcore_ptr[cpu]->ext_call_fast);
Martin Schwidefskyd98e19c2011-10-30 15:16:58 +0100221 while (1) {
222 order = smp_vcpu_scheduled(cpu) ?
223 sigp_external_call : sigp_emergency_signal;
224 if (sigp(cpu, order) != sigp_busy)
225 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700226 udelay(10);
Martin Schwidefskyd98e19c2011-10-30 15:16:58 +0100227 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228}
229
Rusty Russell630cd042009-09-24 09:34:45 -0600230void arch_send_call_function_ipi_mask(const struct cpumask *mask)
Heiko Carstensca9fc752008-12-25 13:38:39 +0100231{
232 int cpu;
233
Rusty Russell630cd042009-09-24 09:34:45 -0600234 for_each_cpu(cpu, mask)
Heiko Carstensca9fc752008-12-25 13:38:39 +0100235 smp_ext_bitcall(cpu, ec_call_function);
236}
237
238void arch_send_call_function_single_ipi(int cpu)
239{
240 smp_ext_bitcall(cpu, ec_call_function_single);
241}
242
Martin Schwidefsky347a8dc2006-01-06 00:19:28 -0800243#ifndef CONFIG_64BIT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700244/*
245 * this function sends a 'purge tlb' signal to another CPU.
246 */
Heiko Carstensa8061702008-04-17 07:46:26 +0200247static void smp_ptlb_callback(void *info)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248{
Martin Schwidefskyba8a9222007-10-22 12:52:44 +0200249 __tlb_flush_local();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250}
251
252void smp_ptlb_all(void)
253{
Jens Axboe15c8b6c2008-05-09 09:39:44 +0200254 on_each_cpu(smp_ptlb_callback, NULL, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255}
256EXPORT_SYMBOL(smp_ptlb_all);
Martin Schwidefsky347a8dc2006-01-06 00:19:28 -0800257#endif /* ! CONFIG_64BIT */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700258
259/*
260 * this function sends a 'reschedule' IPI to another CPU.
261 * it goes straight through and wastes no time serializing
262 * anything. Worst case is that we lose a reschedule ...
263 */
264void smp_send_reschedule(int cpu)
265{
Heiko Carstens39ce0102007-04-27 16:02:00 +0200266 smp_ext_bitcall(cpu, ec_schedule);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700267}
268
269/*
270 * parameter area for the set/clear control bit callbacks
271 */
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200272struct ec_creg_mask_parms {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700273 unsigned long orvals[16];
274 unsigned long andvals[16];
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200275};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276
277/*
278 * callback for setting/clearing control bits
279 */
Heiko Carstens39ce0102007-04-27 16:02:00 +0200280static void smp_ctl_bit_callback(void *info)
281{
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200282 struct ec_creg_mask_parms *pp = info;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283 unsigned long cregs[16];
284 int i;
Heiko Carstens39ce0102007-04-27 16:02:00 +0200285
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200286 __ctl_store(cregs, 0, 15);
287 for (i = 0; i <= 15; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700288 cregs[i] = (cregs[i] & pp->andvals[i]) | pp->orvals[i];
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200289 __ctl_load(cregs, 0, 15);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700290}
291
292/*
293 * Set a bit in a control register of all cpus
294 */
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200295void smp_ctl_set_bit(int cr, int bit)
296{
297 struct ec_creg_mask_parms parms;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200299 memset(&parms.orvals, 0, sizeof(parms.orvals));
300 memset(&parms.andvals, 0xff, sizeof(parms.andvals));
Jan Glauber859c9652011-06-22 16:24:10 +0200301 parms.orvals[cr] = 1UL << bit;
Jens Axboe15c8b6c2008-05-09 09:39:44 +0200302 on_each_cpu(smp_ctl_bit_callback, &parms, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700303}
Heiko Carstens39ce0102007-04-27 16:02:00 +0200304EXPORT_SYMBOL(smp_ctl_set_bit);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700305
306/*
307 * Clear a bit in a control register of all cpus
308 */
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200309void smp_ctl_clear_bit(int cr, int bit)
310{
311 struct ec_creg_mask_parms parms;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700312
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200313 memset(&parms.orvals, 0, sizeof(parms.orvals));
314 memset(&parms.andvals, 0xff, sizeof(parms.andvals));
Jan Glauber859c9652011-06-22 16:24:10 +0200315 parms.andvals[cr] = ~(1UL << bit);
Jens Axboe15c8b6c2008-05-09 09:39:44 +0200316 on_each_cpu(smp_ctl_bit_callback, &parms, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700317}
Heiko Carstens39ce0102007-04-27 16:02:00 +0200318EXPORT_SYMBOL(smp_ctl_clear_bit);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319
Michael Holzheu60a0c682011-10-30 15:16:40 +0100320#if defined(CONFIG_ZFCPDUMP) || defined(CONFIG_CRASH_DUMP)
Michael Holzheu411ed322007-04-27 16:01:49 +0200321
Heiko Carstens285f6722007-07-10 11:24:13 +0200322static void __init smp_get_save_area(unsigned int cpu, unsigned int phy_cpu)
Michael Holzheu411ed322007-04-27 16:01:49 +0200323{
Michael Holzheu60a0c682011-10-30 15:16:40 +0100324 if (ipl_info.type != IPL_TYPE_FCP_DUMP && !OLDMEM_BASE)
325 return;
326 if (is_kdump_kernel())
Michael Holzheu411ed322007-04-27 16:01:49 +0200327 return;
Heiko Carstens285f6722007-07-10 11:24:13 +0200328 if (cpu >= NR_CPUS) {
Martin Schwidefsky395d31d2008-12-25 13:39:50 +0100329 pr_warning("CPU %i exceeds the maximum %i and is excluded from "
330 "the dump\n", cpu, NR_CPUS - 1);
Heiko Carstens285f6722007-07-10 11:24:13 +0200331 return;
Michael Holzheu411ed322007-04-27 16:01:49 +0200332 }
Heiko Carstensf64ca212010-02-26 22:37:32 +0100333 zfcpdump_save_areas[cpu] = kmalloc(sizeof(struct save_area), GFP_KERNEL);
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100334 while (raw_sigp(phy_cpu, sigp_stop_and_store_status) == sigp_busy)
Heiko Carstens285f6722007-07-10 11:24:13 +0200335 cpu_relax();
Michael Holzheu92fe3132010-03-24 11:49:50 +0100336 memcpy_real(zfcpdump_save_areas[cpu],
337 (void *)(unsigned long) store_prefix() + SAVE_AREA_BASE,
338 sizeof(struct save_area));
Michael Holzheu411ed322007-04-27 16:01:49 +0200339}
340
Heiko Carstensf64ca212010-02-26 22:37:32 +0100341struct save_area *zfcpdump_save_areas[NR_CPUS + 1];
Michael Holzheu411ed322007-04-27 16:01:49 +0200342EXPORT_SYMBOL_GPL(zfcpdump_save_areas);
343
344#else
Heiko Carstens285f6722007-07-10 11:24:13 +0200345
346static inline void smp_get_save_area(unsigned int cpu, unsigned int phy_cpu) { }
347
Michael Holzheu59f2e692009-03-26 15:24:46 +0100348#endif /* CONFIG_ZFCPDUMP */
Michael Holzheu411ed322007-04-27 16:01:49 +0200349
Heiko Carstens08d07962008-01-26 14:10:56 +0100350static int cpu_known(int cpu_id)
351{
352 int cpu;
353
354 for_each_present_cpu(cpu) {
355 if (__cpu_logical_map[cpu] == cpu_id)
356 return 1;
357 }
358 return 0;
359}
360
361static int smp_rescan_cpus_sigp(cpumask_t avail)
362{
363 int cpu_id, logical_cpu;
364
Rusty Russell93632d12009-03-26 15:24:59 +0100365 logical_cpu = cpumask_first(&avail);
366 if (logical_cpu >= nr_cpu_ids)
Heiko Carstens08d07962008-01-26 14:10:56 +0100367 return 0;
Heiko Carstens4bb5e072009-09-11 10:29:03 +0200368 for (cpu_id = 0; cpu_id <= MAX_CPU_ADDRESS; cpu_id++) {
Heiko Carstens08d07962008-01-26 14:10:56 +0100369 if (cpu_known(cpu_id))
370 continue;
371 __cpu_logical_map[logical_cpu] = cpu_id;
Heiko Carstensc10fde02008-04-17 07:46:13 +0200372 smp_cpu_polarization[logical_cpu] = POLARIZATION_UNKNWN;
Heiko Carstens08d07962008-01-26 14:10:56 +0100373 if (!cpu_stopped(logical_cpu))
374 continue;
KOSAKI Motohiro0f1959f2011-05-23 10:24:36 +0200375 set_cpu_present(logical_cpu, true);
Heiko Carstens08d07962008-01-26 14:10:56 +0100376 smp_cpu_state[logical_cpu] = CPU_STATE_CONFIGURED;
Rusty Russell93632d12009-03-26 15:24:59 +0100377 logical_cpu = cpumask_next(logical_cpu, &avail);
378 if (logical_cpu >= nr_cpu_ids)
Heiko Carstens08d07962008-01-26 14:10:56 +0100379 break;
380 }
381 return 0;
382}
383
Heiko Carstens48483b32008-01-26 14:11:05 +0100384static int smp_rescan_cpus_sclp(cpumask_t avail)
Heiko Carstens08d07962008-01-26 14:10:56 +0100385{
386 struct sclp_cpu_info *info;
387 int cpu_id, logical_cpu, cpu;
388 int rc;
389
Rusty Russell93632d12009-03-26 15:24:59 +0100390 logical_cpu = cpumask_first(&avail);
391 if (logical_cpu >= nr_cpu_ids)
Heiko Carstens08d07962008-01-26 14:10:56 +0100392 return 0;
Heiko Carstens48483b32008-01-26 14:11:05 +0100393 info = kmalloc(sizeof(*info), GFP_KERNEL);
Heiko Carstens08d07962008-01-26 14:10:56 +0100394 if (!info)
395 return -ENOMEM;
396 rc = sclp_get_cpu_info(info);
397 if (rc)
398 goto out;
399 for (cpu = 0; cpu < info->combined; cpu++) {
400 if (info->has_cpu_type && info->cpu[cpu].type != smp_cpu_type)
401 continue;
402 cpu_id = info->cpu[cpu].address;
403 if (cpu_known(cpu_id))
404 continue;
405 __cpu_logical_map[logical_cpu] = cpu_id;
Heiko Carstensc10fde02008-04-17 07:46:13 +0200406 smp_cpu_polarization[logical_cpu] = POLARIZATION_UNKNWN;
KOSAKI Motohiro0f1959f2011-05-23 10:24:36 +0200407 set_cpu_present(logical_cpu, true);
Heiko Carstens08d07962008-01-26 14:10:56 +0100408 if (cpu >= info->configured)
409 smp_cpu_state[logical_cpu] = CPU_STATE_STANDBY;
410 else
411 smp_cpu_state[logical_cpu] = CPU_STATE_CONFIGURED;
Rusty Russell93632d12009-03-26 15:24:59 +0100412 logical_cpu = cpumask_next(logical_cpu, &avail);
413 if (logical_cpu >= nr_cpu_ids)
Heiko Carstens08d07962008-01-26 14:10:56 +0100414 break;
415 }
416out:
Heiko Carstens48483b32008-01-26 14:11:05 +0100417 kfree(info);
Heiko Carstens08d07962008-01-26 14:10:56 +0100418 return rc;
419}
420
Heiko Carstens1e489512008-04-30 13:38:37 +0200421static int __smp_rescan_cpus(void)
Heiko Carstens08d07962008-01-26 14:10:56 +0100422{
423 cpumask_t avail;
424
KOSAKI Motohiro0f1959f2011-05-23 10:24:36 +0200425 cpumask_xor(&avail, cpu_possible_mask, cpu_present_mask);
Heiko Carstens08d07962008-01-26 14:10:56 +0100426 if (smp_use_sigp_detection)
427 return smp_rescan_cpus_sigp(avail);
428 else
429 return smp_rescan_cpus_sclp(avail);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700430}
431
Heiko Carstens48483b32008-01-26 14:11:05 +0100432static void __init smp_detect_cpus(void)
433{
434 unsigned int cpu, c_cpus, s_cpus;
435 struct sclp_cpu_info *info;
436 u16 boot_cpu_addr, cpu_addr;
437
438 c_cpus = 1;
439 s_cpus = 0;
Martin Schwidefsky7b468482009-03-26 15:24:42 +0100440 boot_cpu_addr = __cpu_logical_map[0];
Heiko Carstens48483b32008-01-26 14:11:05 +0100441 info = kmalloc(sizeof(*info), GFP_KERNEL);
442 if (!info)
443 panic("smp_detect_cpus failed to allocate memory\n");
Michael Holzheu60a0c682011-10-30 15:16:40 +0100444#ifdef CONFIG_CRASH_DUMP
445 if (OLDMEM_BASE && !is_kdump_kernel()) {
446 struct save_area *save_area;
447
448 save_area = kmalloc(sizeof(*save_area), GFP_KERNEL);
449 if (!save_area)
450 panic("could not allocate memory for save area\n");
451 copy_oldmem_page(1, (void *) save_area, sizeof(*save_area),
452 0x200, 0);
453 zfcpdump_save_areas[0] = save_area;
454 }
455#endif
Heiko Carstens48483b32008-01-26 14:11:05 +0100456 /* Use sigp detection algorithm if sclp doesn't work. */
457 if (sclp_get_cpu_info(info)) {
458 smp_use_sigp_detection = 1;
Heiko Carstens4bb5e072009-09-11 10:29:03 +0200459 for (cpu = 0; cpu <= MAX_CPU_ADDRESS; cpu++) {
Heiko Carstens48483b32008-01-26 14:11:05 +0100460 if (cpu == boot_cpu_addr)
461 continue;
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100462 if (!raw_cpu_stopped(cpu))
Heiko Carstens48483b32008-01-26 14:11:05 +0100463 continue;
464 smp_get_save_area(c_cpus, cpu);
465 c_cpus++;
466 }
467 goto out;
468 }
469
470 if (info->has_cpu_type) {
471 for (cpu = 0; cpu < info->combined; cpu++) {
472 if (info->cpu[cpu].address == boot_cpu_addr) {
473 smp_cpu_type = info->cpu[cpu].type;
474 break;
475 }
476 }
477 }
478
479 for (cpu = 0; cpu < info->combined; cpu++) {
480 if (info->has_cpu_type && info->cpu[cpu].type != smp_cpu_type)
481 continue;
482 cpu_addr = info->cpu[cpu].address;
483 if (cpu_addr == boot_cpu_addr)
484 continue;
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100485 if (!raw_cpu_stopped(cpu_addr)) {
Heiko Carstens48483b32008-01-26 14:11:05 +0100486 s_cpus++;
487 continue;
488 }
489 smp_get_save_area(c_cpus, cpu_addr);
490 c_cpus++;
491 }
492out:
493 kfree(info);
Martin Schwidefsky395d31d2008-12-25 13:39:50 +0100494 pr_info("%d configured CPUs, %d standby CPUs\n", c_cpus, s_cpus);
Martin Schwidefsky9d40d2e2008-01-26 14:11:31 +0100495 get_online_cpus();
Heiko Carstens1e489512008-04-30 13:38:37 +0200496 __smp_rescan_cpus();
Martin Schwidefsky9d40d2e2008-01-26 14:11:31 +0100497 put_online_cpus();
Heiko Carstens48483b32008-01-26 14:11:05 +0100498}
499
Linus Torvalds1da177e2005-04-16 15:20:36 -0700500/*
Heiko Carstens39ce0102007-04-27 16:02:00 +0200501 * Activate a secondary processor.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700502 */
Heiko Carstensea1f4ee2007-05-31 17:38:05 +0200503int __cpuinit start_secondary(void *cpuvoid)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504{
Heiko Carstens39ce0102007-04-27 16:02:00 +0200505 cpu_init();
Nick Piggin5bfb5d62005-11-08 21:39:01 -0800506 preempt_disable();
Heiko Carstens39ce0102007-04-27 16:02:00 +0200507 init_cpu_timer();
Heiko Carstens39ce0102007-04-27 16:02:00 +0200508 init_cpu_vtimer();
Heiko Carstens29b08d22006-12-04 15:40:40 +0100509 pfault_init();
510
Manfred Spraule545a612008-09-07 16:57:22 +0200511 notify_cpu_starting(smp_processor_id());
Heiko Carstensca9fc752008-12-25 13:38:39 +0100512 ipi_call_lock();
KOSAKI Motohiro0f1959f2011-05-23 10:24:36 +0200513 set_cpu_online(smp_processor_id(), true);
Heiko Carstensca9fc752008-12-25 13:38:39 +0100514 ipi_call_unlock();
Michael Holzheu7dd6b332011-08-03 16:44:19 +0200515 __ctl_clear_bit(0, 28); /* Disable lowcore protection */
Martin Schwidefskyb50511e2011-10-30 15:16:50 +0100516 S390_lowcore.restart_psw.mask =
517 PSW_DEFAULT_KEY | PSW_MASK_BASE | PSW_MASK_EA | PSW_MASK_BA;
Michael Holzheu7dd6b332011-08-03 16:44:19 +0200518 S390_lowcore.restart_psw.addr =
519 PSW_ADDR_AMODE | (unsigned long) psw_restart_int_handler;
520 __ctl_set_bit(0, 28); /* Enable lowcore protection */
Heiko Carstenscc343212011-08-03 16:44:27 +0200521 /*
522 * Wait until the cpu which brought this one up marked it
523 * active before enabling interrupts.
524 */
525 while (!cpumask_test_cpu(smp_processor_id(), cpu_active_mask))
526 cpu_relax();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527 local_irq_enable();
Heiko Carstens39ce0102007-04-27 16:02:00 +0200528 /* cpu_idle will call schedule for us */
529 cpu_idle();
530 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700531}
532
Heiko Carstensf2308862011-01-05 12:48:08 +0100533struct create_idle {
534 struct work_struct work;
535 struct task_struct *idle;
536 struct completion done;
537 int cpu;
538};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539
Heiko Carstensf2308862011-01-05 12:48:08 +0100540static void __cpuinit smp_fork_idle(struct work_struct *work)
541{
542 struct create_idle *c_idle;
543
544 c_idle = container_of(work, struct create_idle, work);
545 c_idle->idle = fork_idle(c_idle->cpu);
546 complete(&c_idle->done);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700547}
548
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100549static int __cpuinit smp_alloc_lowcore(int cpu)
550{
551 unsigned long async_stack, panic_stack;
552 struct _lowcore *lowcore;
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100553
Heiko Carstens3fd26a72009-09-22 22:58:49 +0200554 lowcore = (void *) __get_free_pages(GFP_KERNEL | GFP_DMA, LC_ORDER);
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100555 if (!lowcore)
556 return -ENOMEM;
557 async_stack = __get_free_pages(GFP_KERNEL, ASYNC_ORDER);
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100558 panic_stack = __get_free_page(GFP_KERNEL);
Heiko Carstens591bb4f2008-02-19 15:29:29 +0100559 if (!panic_stack || !async_stack)
560 goto out;
Heiko Carstens98c7b382008-03-05 12:37:09 +0100561 memcpy(lowcore, &S390_lowcore, 512);
562 memset((char *)lowcore + 512, 0, sizeof(*lowcore) - 512);
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100563 lowcore->async_stack = async_stack + ASYNC_SIZE;
564 lowcore->panic_stack = panic_stack + PAGE_SIZE;
Martin Schwidefskyb50511e2011-10-30 15:16:50 +0100565 lowcore->restart_psw.mask =
566 PSW_DEFAULT_KEY | PSW_MASK_BASE | PSW_MASK_EA | PSW_MASK_BA;
Michael Holzheu7dd6b332011-08-03 16:44:19 +0200567 lowcore->restart_psw.addr =
568 PSW_ADDR_AMODE | (unsigned long) restart_int_handler;
569 if (user_mode != HOME_SPACE_MODE)
570 lowcore->restart_psw.mask |= PSW_ASC_HOME;
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100571#ifndef CONFIG_64BIT
572 if (MACHINE_HAS_IEEE) {
573 unsigned long save_area;
574
575 save_area = get_zeroed_page(GFP_KERNEL);
576 if (!save_area)
Martin Schwidefsky33b1d092008-12-25 13:39:27 +0100577 goto out;
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100578 lowcore->extended_save_area_addr = (u32) save_area;
579 }
Martin Schwidefskyc742b312008-12-31 15:11:42 +0100580#else
581 if (vdso_alloc_per_cpu(cpu, lowcore))
582 goto out;
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100583#endif
584 lowcore_ptr[cpu] = lowcore;
585 return 0;
586
Heiko Carstens591bb4f2008-02-19 15:29:29 +0100587out:
Martin Schwidefsky33b1d092008-12-25 13:39:27 +0100588 free_page(panic_stack);
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100589 free_pages(async_stack, ASYNC_ORDER);
Heiko Carstens3fd26a72009-09-22 22:58:49 +0200590 free_pages((unsigned long) lowcore, LC_ORDER);
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100591 return -ENOMEM;
592}
593
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100594static void smp_free_lowcore(int cpu)
595{
596 struct _lowcore *lowcore;
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100597
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100598 lowcore = lowcore_ptr[cpu];
599#ifndef CONFIG_64BIT
600 if (MACHINE_HAS_IEEE)
601 free_page((unsigned long) lowcore->extended_save_area_addr);
Martin Schwidefskyc742b312008-12-31 15:11:42 +0100602#else
603 vdso_free_per_cpu(cpu, lowcore);
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100604#endif
605 free_page(lowcore->panic_stack - PAGE_SIZE);
606 free_pages(lowcore->async_stack - ASYNC_SIZE, ASYNC_ORDER);
Heiko Carstens3fd26a72009-09-22 22:58:49 +0200607 free_pages((unsigned long) lowcore, LC_ORDER);
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100608 lowcore_ptr[cpu] = NULL;
609}
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100610
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611/* Upping and downing of CPUs */
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100612int __cpuinit __cpu_up(unsigned int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700613{
Heiko Carstens39ce0102007-04-27 16:02:00 +0200614 struct _lowcore *cpu_lowcore;
Heiko Carstensf2308862011-01-05 12:48:08 +0100615 struct create_idle c_idle;
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100616 struct task_struct *idle;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700617 struct stack_frame *sf;
Heiko Carstensd0d3cdf2009-03-26 15:24:53 +0100618 u32 lowcore;
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100619 int ccode;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700620
Heiko Carstens08d07962008-01-26 14:10:56 +0100621 if (smp_cpu_state[cpu] != CPU_STATE_CONFIGURED)
622 return -EIO;
Heiko Carstensf2308862011-01-05 12:48:08 +0100623 idle = current_set[cpu];
624 if (!idle) {
625 c_idle.done = COMPLETION_INITIALIZER_ONSTACK(c_idle.done);
626 INIT_WORK_ONSTACK(&c_idle.work, smp_fork_idle);
627 c_idle.cpu = cpu;
628 schedule_work(&c_idle.work);
629 wait_for_completion(&c_idle.done);
630 if (IS_ERR(c_idle.idle))
631 return PTR_ERR(c_idle.idle);
632 idle = c_idle.idle;
633 current_set[cpu] = c_idle.idle;
634 }
Heiko Carstensda7f51c2011-01-05 12:48:09 +0100635 init_idle(idle, cpu);
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100636 if (smp_alloc_lowcore(cpu))
637 return -ENOMEM;
Heiko Carstensd0d3cdf2009-03-26 15:24:53 +0100638 do {
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100639 ccode = sigp(cpu, sigp_initial_cpu_reset);
Heiko Carstensd0d3cdf2009-03-26 15:24:53 +0100640 if (ccode == sigp_busy)
641 udelay(10);
642 if (ccode == sigp_not_operational)
643 goto err_out;
644 } while (ccode == sigp_busy);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700645
Heiko Carstensd0d3cdf2009-03-26 15:24:53 +0100646 lowcore = (u32)(unsigned long)lowcore_ptr[cpu];
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100647 while (sigp_p(lowcore, cpu, sigp_set_prefix) == sigp_busy)
Heiko Carstensd0d3cdf2009-03-26 15:24:53 +0100648 udelay(10);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700649
Heiko Carstens39ce0102007-04-27 16:02:00 +0200650 cpu_lowcore = lowcore_ptr[cpu];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700651 cpu_lowcore->kernel_stack = (unsigned long)
Heiko Carstens39ce0102007-04-27 16:02:00 +0200652 task_stack_page(idle) + THREAD_SIZE;
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100653 cpu_lowcore->thread_info = (unsigned long) task_thread_info(idle);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700654 sf = (struct stack_frame *) (cpu_lowcore->kernel_stack
655 - sizeof(struct pt_regs)
656 - sizeof(struct stack_frame));
657 memset(sf, 0, sizeof(struct stack_frame));
658 sf->gprs[9] = (unsigned long) sf;
659 cpu_lowcore->save_area[15] = (unsigned long) sf;
Segher Boessenkool24d3e212008-06-10 10:03:23 +0200660 __ctl_store(cpu_lowcore->cregs_save_area, 0, 15);
Martin Schwidefsky050eef32010-08-24 09:26:21 +0200661 atomic_inc(&init_mm.context.attach_count);
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200662 asm volatile(
663 " stam 0,15,0(%0)"
664 : : "a" (&cpu_lowcore->access_regs_save_area) : "memory");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700665 cpu_lowcore->percpu_offset = __per_cpu_offset[cpu];
Heiko Carstens39ce0102007-04-27 16:02:00 +0200666 cpu_lowcore->current_task = (unsigned long) idle;
Martin Schwidefsky7b468482009-03-26 15:24:42 +0100667 cpu_lowcore->cpu_nr = cpu;
Heiko Carstens591bb4f2008-02-19 15:29:29 +0100668 cpu_lowcore->kernel_asce = S390_lowcore.kernel_asce;
Christian Ehrhardt25097bf2009-04-14 15:36:16 +0200669 cpu_lowcore->machine_flags = S390_lowcore.machine_flags;
Heiko Carstensdfd9f7a2009-06-12 10:26:44 +0200670 cpu_lowcore->ftrace_func = S390_lowcore.ftrace_func;
Martin Schwidefsky14375bc2010-10-25 16:10:51 +0200671 memcpy(cpu_lowcore->stfle_fac_list, S390_lowcore.stfle_fac_list,
672 MAX_FACILITY_BIT/8);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700673 eieio();
Michael Ryan699ff132006-03-24 03:15:17 -0800674
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100675 while (sigp(cpu, sigp_restart) == sigp_busy)
Michael Ryan699ff132006-03-24 03:15:17 -0800676 udelay(10);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700677
678 while (!cpu_online(cpu))
679 cpu_relax();
680 return 0;
Heiko Carstensd0d3cdf2009-03-26 15:24:53 +0100681
682err_out:
683 smp_free_lowcore(cpu);
684 return -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700685}
686
Heiko Carstens37a33022006-02-17 13:52:47 -0800687static int __init setup_possible_cpus(char *s)
688{
Heiko Carstens48483b32008-01-26 14:11:05 +0100689 int pcpus, cpu;
690
691 pcpus = simple_strtoul(s, NULL, 0);
Heiko Carstens88e01282009-04-14 15:36:25 +0200692 init_cpu_possible(cpumask_of(0));
693 for (cpu = 1; cpu < pcpus && cpu < nr_cpu_ids; cpu++)
Rusty Russelldef6cfb2009-03-26 15:25:00 +0100694 set_cpu_possible(cpu, true);
Heiko Carstens37a33022006-02-17 13:52:47 -0800695 return 0;
696}
697early_param("possible_cpus", setup_possible_cpus);
698
Heiko Carstens48483b32008-01-26 14:11:05 +0100699#ifdef CONFIG_HOTPLUG_CPU
700
Heiko Carstens39ce0102007-04-27 16:02:00 +0200701int __cpu_disable(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702{
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200703 struct ec_creg_mask_parms cr_parms;
Zwane Mwaikambof3705132005-06-25 14:54:50 -0700704 int cpu = smp_processor_id();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700705
KOSAKI Motohiro0f1959f2011-05-23 10:24:36 +0200706 set_cpu_online(cpu, false);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700707
Linus Torvalds1da177e2005-04-16 15:20:36 -0700708 /* Disable pfault pseudo page faults on this cpu. */
Heiko Carstens29b08d22006-12-04 15:40:40 +0100709 pfault_fini();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700710
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200711 memset(&cr_parms.orvals, 0, sizeof(cr_parms.orvals));
712 memset(&cr_parms.andvals, 0xff, sizeof(cr_parms.andvals));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700713
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200714 /* disable all external interrupts */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715 cr_parms.orvals[0] = 0;
Heiko Carstens5bd41872011-05-23 10:24:50 +0200716 cr_parms.andvals[0] = ~(1 << 15 | 1 << 14 | 1 << 13 | 1 << 11 |
Jan Glaubercadfce72011-07-24 10:48:30 +0200717 1 << 10 | 1 << 9 | 1 << 6 | 1 << 5 |
718 1 << 4);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719 /* disable all I/O interrupts */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700720 cr_parms.orvals[6] = 0;
Heiko Carstens39ce0102007-04-27 16:02:00 +0200721 cr_parms.andvals[6] = ~(1 << 31 | 1 << 30 | 1 << 29 | 1 << 28 |
722 1 << 27 | 1 << 26 | 1 << 25 | 1 << 24);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700723 /* disable most machine checks */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700724 cr_parms.orvals[14] = 0;
Heiko Carstens39ce0102007-04-27 16:02:00 +0200725 cr_parms.andvals[14] = ~(1 << 28 | 1 << 27 | 1 << 26 |
726 1 << 25 | 1 << 24);
Martin Schwidefsky94c12cc2006-09-28 16:56:43 +0200727
Linus Torvalds1da177e2005-04-16 15:20:36 -0700728 smp_ctl_bit_callback(&cr_parms);
729
Linus Torvalds1da177e2005-04-16 15:20:36 -0700730 return 0;
731}
732
Heiko Carstens39ce0102007-04-27 16:02:00 +0200733void __cpu_die(unsigned int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700734{
735 /* Wait until target cpu is down */
Heiko Carstens5c0b9122009-09-11 10:29:05 +0200736 while (!cpu_stopped(cpu))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700737 cpu_relax();
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100738 while (sigp_p(0, cpu, sigp_set_prefix) == sigp_busy)
Heiko Carstens4f8048e2009-10-29 15:04:09 +0100739 udelay(10);
Heiko Carstens1cb6bb42008-01-26 14:11:14 +0100740 smp_free_lowcore(cpu);
Martin Schwidefsky050eef32010-08-24 09:26:21 +0200741 atomic_dec(&init_mm.context.attach_count);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742}
743
Heiko Carstensb456d942011-05-23 10:24:33 +0200744void __noreturn cpu_die(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700745{
746 idle_task_exit();
Heiko Carstensa93b8ec2010-02-26 22:37:35 +0100747 while (sigp(smp_processor_id(), sigp_stop) == sigp_busy)
Heiko Carstensf8501ba2009-10-29 15:04:13 +0100748 cpu_relax();
Heiko Carstens39ce0102007-04-27 16:02:00 +0200749 for (;;);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700750}
751
Heiko Carstens255acee2006-02-17 13:52:46 -0800752#endif /* CONFIG_HOTPLUG_CPU */
753
Linus Torvalds1da177e2005-04-16 15:20:36 -0700754void __init smp_prepare_cpus(unsigned int max_cpus)
755{
Heiko Carstens591bb4f2008-02-19 15:29:29 +0100756#ifndef CONFIG_64BIT
757 unsigned long save_area = 0;
758#endif
759 unsigned long async_stack, panic_stack;
760 struct _lowcore *lowcore;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761
Heiko Carstens48483b32008-01-26 14:11:05 +0100762 smp_detect_cpus();
763
Heiko Carstens39ce0102007-04-27 16:02:00 +0200764 /* request the 0x1201 emergency signal external interrupt */
765 if (register_external_interrupt(0x1201, do_ext_call_interrupt) != 0)
766 panic("Couldn't request external interrupt 0x1201");
Martin Schwidefskyd98e19c2011-10-30 15:16:58 +0100767 /* request the 0x1202 external call external interrupt */
768 if (register_external_interrupt(0x1202, do_ext_call_interrupt) != 0)
769 panic("Couldn't request external interrupt 0x1202");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700770
Heiko Carstens591bb4f2008-02-19 15:29:29 +0100771 /* Reallocate current lowcore, but keep its contents. */
Heiko Carstens3fd26a72009-09-22 22:58:49 +0200772 lowcore = (void *) __get_free_pages(GFP_KERNEL | GFP_DMA, LC_ORDER);
Heiko Carstens591bb4f2008-02-19 15:29:29 +0100773 panic_stack = __get_free_page(GFP_KERNEL);
774 async_stack = __get_free_pages(GFP_KERNEL, ASYNC_ORDER);
Martin Schwidefskyc742b312008-12-31 15:11:42 +0100775 BUG_ON(!lowcore || !panic_stack || !async_stack);
Martin Schwidefsky347a8dc2006-01-06 00:19:28 -0800776#ifndef CONFIG_64BIT
Heiko Carstens77fa2242005-06-25 14:55:30 -0700777 if (MACHINE_HAS_IEEE)
Heiko Carstens591bb4f2008-02-19 15:29:29 +0100778 save_area = get_zeroed_page(GFP_KERNEL);
Heiko Carstens77fa2242005-06-25 14:55:30 -0700779#endif
Heiko Carstens591bb4f2008-02-19 15:29:29 +0100780 local_irq_disable();
781 local_mcck_disable();
782 lowcore_ptr[smp_processor_id()] = lowcore;
783 *lowcore = S390_lowcore;
784 lowcore->panic_stack = panic_stack + PAGE_SIZE;
785 lowcore->async_stack = async_stack + ASYNC_SIZE;
786#ifndef CONFIG_64BIT
787 if (MACHINE_HAS_IEEE)
788 lowcore->extended_save_area_addr = (u32) save_area;
789#endif
790 set_prefix((u32)(unsigned long) lowcore);
791 local_mcck_enable();
792 local_irq_enable();
Heiko Carstens3a6ba462009-07-24 12:39:51 +0200793#ifdef CONFIG_64BIT
794 if (vdso_alloc_per_cpu(smp_processor_id(), &S390_lowcore))
795 BUG();
796#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700797}
798
Heiko Carstensea1f4ee2007-05-31 17:38:05 +0200799void __init smp_prepare_boot_cpu(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700800{
801 BUG_ON(smp_processor_id() != 0);
802
Heiko Carstens48483b32008-01-26 14:11:05 +0100803 current_thread_info()->cpu = 0;
KOSAKI Motohiro0f1959f2011-05-23 10:24:36 +0200804 set_cpu_present(0, true);
805 set_cpu_online(0, true);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700806 S390_lowcore.percpu_offset = __per_cpu_offset[0];
807 current_set[0] = current;
Heiko Carstens08d07962008-01-26 14:10:56 +0100808 smp_cpu_state[0] = CPU_STATE_CONFIGURED;
Heiko Carstensc10fde02008-04-17 07:46:13 +0200809 smp_cpu_polarization[0] = POLARIZATION_UNKNWN;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700810}
811
Heiko Carstensea1f4ee2007-05-31 17:38:05 +0200812void __init smp_cpus_done(unsigned int max_cpus)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700813{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700814}
815
Heiko Carstens02beacc2010-01-13 20:44:34 +0100816void __init smp_setup_processor_id(void)
817{
818 S390_lowcore.cpu_nr = 0;
819 __cpu_logical_map[0] = stap();
820}
821
Linus Torvalds1da177e2005-04-16 15:20:36 -0700822/*
823 * the frequency of the profiling timer can be changed
824 * by writing a multiplier value into /proc/profile.
825 *
826 * usually you want to run this on all CPUs ;)
827 */
828int setup_profiling_timer(unsigned int multiplier)
829{
Heiko Carstens39ce0102007-04-27 16:02:00 +0200830 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700831}
832
Heiko Carstens08d07962008-01-26 14:10:56 +0100833#ifdef CONFIG_HOTPLUG_CPU
Andi Kleen4a0b2b42008-07-01 18:48:41 +0200834static ssize_t cpu_configure_show(struct sys_device *dev,
835 struct sysdev_attribute *attr, char *buf)
Heiko Carstens08d07962008-01-26 14:10:56 +0100836{
837 ssize_t count;
838
839 mutex_lock(&smp_cpu_state_mutex);
840 count = sprintf(buf, "%d\n", smp_cpu_state[dev->id]);
841 mutex_unlock(&smp_cpu_state_mutex);
842 return count;
843}
844
Andi Kleen4a0b2b42008-07-01 18:48:41 +0200845static ssize_t cpu_configure_store(struct sys_device *dev,
846 struct sysdev_attribute *attr,
847 const char *buf, size_t count)
Heiko Carstens08d07962008-01-26 14:10:56 +0100848{
849 int cpu = dev->id;
850 int val, rc;
851 char delim;
852
853 if (sscanf(buf, "%d %c", &val, &delim) != 1)
854 return -EINVAL;
855 if (val != 0 && val != 1)
856 return -EINVAL;
857
Martin Schwidefsky9d40d2e2008-01-26 14:11:31 +0100858 get_online_cpus();
Heiko Carstens0b18d312008-04-30 13:38:36 +0200859 mutex_lock(&smp_cpu_state_mutex);
Heiko Carstens08d07962008-01-26 14:10:56 +0100860 rc = -EBUSY;
Heiko Carstens2c2df112010-02-26 22:37:34 +0100861 /* disallow configuration changes of online cpus and cpu 0 */
862 if (cpu_online(cpu) || cpu == 0)
Heiko Carstens08d07962008-01-26 14:10:56 +0100863 goto out;
864 rc = 0;
865 switch (val) {
866 case 0:
867 if (smp_cpu_state[cpu] == CPU_STATE_CONFIGURED) {
868 rc = sclp_cpu_deconfigure(__cpu_logical_map[cpu]);
Heiko Carstensc10fde02008-04-17 07:46:13 +0200869 if (!rc) {
Heiko Carstens08d07962008-01-26 14:10:56 +0100870 smp_cpu_state[cpu] = CPU_STATE_STANDBY;
Heiko Carstensc10fde02008-04-17 07:46:13 +0200871 smp_cpu_polarization[cpu] = POLARIZATION_UNKNWN;
872 }
Heiko Carstens08d07962008-01-26 14:10:56 +0100873 }
874 break;
875 case 1:
876 if (smp_cpu_state[cpu] == CPU_STATE_STANDBY) {
877 rc = sclp_cpu_configure(__cpu_logical_map[cpu]);
Heiko Carstensc10fde02008-04-17 07:46:13 +0200878 if (!rc) {
Heiko Carstens08d07962008-01-26 14:10:56 +0100879 smp_cpu_state[cpu] = CPU_STATE_CONFIGURED;
Heiko Carstensc10fde02008-04-17 07:46:13 +0200880 smp_cpu_polarization[cpu] = POLARIZATION_UNKNWN;
881 }
Heiko Carstens08d07962008-01-26 14:10:56 +0100882 }
883 break;
884 default:
885 break;
886 }
887out:
Heiko Carstens08d07962008-01-26 14:10:56 +0100888 mutex_unlock(&smp_cpu_state_mutex);
Heiko Carstens0b18d312008-04-30 13:38:36 +0200889 put_online_cpus();
Heiko Carstens08d07962008-01-26 14:10:56 +0100890 return rc ? rc : count;
891}
892static SYSDEV_ATTR(configure, 0644, cpu_configure_show, cpu_configure_store);
893#endif /* CONFIG_HOTPLUG_CPU */
894
Andi Kleen4a0b2b42008-07-01 18:48:41 +0200895static ssize_t cpu_polarization_show(struct sys_device *dev,
896 struct sysdev_attribute *attr, char *buf)
Heiko Carstensc10fde02008-04-17 07:46:13 +0200897{
898 int cpu = dev->id;
899 ssize_t count;
900
901 mutex_lock(&smp_cpu_state_mutex);
902 switch (smp_cpu_polarization[cpu]) {
903 case POLARIZATION_HRZ:
904 count = sprintf(buf, "horizontal\n");
905 break;
906 case POLARIZATION_VL:
907 count = sprintf(buf, "vertical:low\n");
908 break;
909 case POLARIZATION_VM:
910 count = sprintf(buf, "vertical:medium\n");
911 break;
912 case POLARIZATION_VH:
913 count = sprintf(buf, "vertical:high\n");
914 break;
915 default:
916 count = sprintf(buf, "unknown\n");
917 break;
918 }
919 mutex_unlock(&smp_cpu_state_mutex);
920 return count;
921}
922static SYSDEV_ATTR(polarization, 0444, cpu_polarization_show, NULL);
923
Andi Kleen4a0b2b42008-07-01 18:48:41 +0200924static ssize_t show_cpu_address(struct sys_device *dev,
925 struct sysdev_attribute *attr, char *buf)
Heiko Carstens08d07962008-01-26 14:10:56 +0100926{
927 return sprintf(buf, "%d\n", __cpu_logical_map[dev->id]);
928}
929static SYSDEV_ATTR(address, 0444, show_cpu_address, NULL);
930
931
932static struct attribute *cpu_common_attrs[] = {
933#ifdef CONFIG_HOTPLUG_CPU
934 &attr_configure.attr,
935#endif
936 &attr_address.attr,
Heiko Carstensc10fde02008-04-17 07:46:13 +0200937 &attr_polarization.attr,
Heiko Carstens08d07962008-01-26 14:10:56 +0100938 NULL,
939};
940
941static struct attribute_group cpu_common_attr_group = {
942 .attrs = cpu_common_attrs,
943};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700944
Andi Kleen4a0b2b42008-07-01 18:48:41 +0200945static ssize_t show_capability(struct sys_device *dev,
946 struct sysdev_attribute *attr, char *buf)
Heiko Carstens2fc2d1e2007-04-27 16:01:56 +0200947{
948 unsigned int capability;
949 int rc;
950
951 rc = get_cpu_capability(&capability);
952 if (rc)
953 return rc;
954 return sprintf(buf, "%u\n", capability);
955}
956static SYSDEV_ATTR(capability, 0444, show_capability, NULL);
957
Andi Kleen4a0b2b42008-07-01 18:48:41 +0200958static ssize_t show_idle_count(struct sys_device *dev,
959 struct sysdev_attribute *attr, char *buf)
Heiko Carstensfae8b222007-10-22 12:52:39 +0200960{
961 struct s390_idle_data *idle;
962 unsigned long long idle_count;
Martin Schwidefskye98bbaa2009-06-22 12:08:20 +0200963 unsigned int sequence;
Heiko Carstensfae8b222007-10-22 12:52:39 +0200964
965 idle = &per_cpu(s390_idle, dev->id);
Martin Schwidefskye98bbaa2009-06-22 12:08:20 +0200966repeat:
967 sequence = idle->sequence;
968 smp_rmb();
969 if (sequence & 1)
970 goto repeat;
Heiko Carstensfae8b222007-10-22 12:52:39 +0200971 idle_count = idle->idle_count;
Martin Schwidefsky6f430922008-12-31 15:11:40 +0100972 if (idle->idle_enter)
973 idle_count++;
Martin Schwidefskye98bbaa2009-06-22 12:08:20 +0200974 smp_rmb();
975 if (idle->sequence != sequence)
976 goto repeat;
Heiko Carstensfae8b222007-10-22 12:52:39 +0200977 return sprintf(buf, "%llu\n", idle_count);
978}
979static SYSDEV_ATTR(idle_count, 0444, show_idle_count, NULL);
980
Andi Kleen4a0b2b42008-07-01 18:48:41 +0200981static ssize_t show_idle_time(struct sys_device *dev,
982 struct sysdev_attribute *attr, char *buf)
Heiko Carstensfae8b222007-10-22 12:52:39 +0200983{
984 struct s390_idle_data *idle;
Martin Schwidefsky6f430922008-12-31 15:11:40 +0100985 unsigned long long now, idle_time, idle_enter;
Martin Schwidefskye98bbaa2009-06-22 12:08:20 +0200986 unsigned int sequence;
Heiko Carstensfae8b222007-10-22 12:52:39 +0200987
988 idle = &per_cpu(s390_idle, dev->id);
Martin Schwidefsky6f430922008-12-31 15:11:40 +0100989 now = get_clock();
Martin Schwidefskye98bbaa2009-06-22 12:08:20 +0200990repeat:
991 sequence = idle->sequence;
992 smp_rmb();
993 if (sequence & 1)
994 goto repeat;
Martin Schwidefsky6f430922008-12-31 15:11:40 +0100995 idle_time = idle->idle_time;
996 idle_enter = idle->idle_enter;
997 if (idle_enter != 0ULL && idle_enter < now)
998 idle_time += now - idle_enter;
Martin Schwidefskye98bbaa2009-06-22 12:08:20 +0200999 smp_rmb();
1000 if (idle->sequence != sequence)
1001 goto repeat;
Martin Schwidefsky6f430922008-12-31 15:11:40 +01001002 return sprintf(buf, "%llu\n", idle_time >> 12);
Heiko Carstensfae8b222007-10-22 12:52:39 +02001003}
Heiko Carstens69d39d62007-11-05 11:10:13 +01001004static SYSDEV_ATTR(idle_time_us, 0444, show_idle_time, NULL);
Heiko Carstensfae8b222007-10-22 12:52:39 +02001005
Heiko Carstens08d07962008-01-26 14:10:56 +01001006static struct attribute *cpu_online_attrs[] = {
Heiko Carstensfae8b222007-10-22 12:52:39 +02001007 &attr_capability.attr,
1008 &attr_idle_count.attr,
Heiko Carstens69d39d62007-11-05 11:10:13 +01001009 &attr_idle_time_us.attr,
Heiko Carstensfae8b222007-10-22 12:52:39 +02001010 NULL,
1011};
1012
Heiko Carstens08d07962008-01-26 14:10:56 +01001013static struct attribute_group cpu_online_attr_group = {
1014 .attrs = cpu_online_attrs,
Heiko Carstensfae8b222007-10-22 12:52:39 +02001015};
1016
Heiko Carstens2fc2d1e2007-04-27 16:01:56 +02001017static int __cpuinit smp_cpu_notify(struct notifier_block *self,
1018 unsigned long action, void *hcpu)
1019{
1020 unsigned int cpu = (unsigned int)(long)hcpu;
1021 struct cpu *c = &per_cpu(cpu_devices, cpu);
1022 struct sys_device *s = &c->sysdev;
Heiko Carstensfae8b222007-10-22 12:52:39 +02001023 struct s390_idle_data *idle;
Akinobu Mitad882ba62010-05-26 14:43:34 -07001024 int err = 0;
Heiko Carstens2fc2d1e2007-04-27 16:01:56 +02001025
1026 switch (action) {
1027 case CPU_ONLINE:
Rafael J. Wysocki8bb78442007-05-09 02:35:10 -07001028 case CPU_ONLINE_FROZEN:
Heiko Carstensfae8b222007-10-22 12:52:39 +02001029 idle = &per_cpu(s390_idle, cpu);
Martin Schwidefskye98bbaa2009-06-22 12:08:20 +02001030 memset(idle, 0, sizeof(struct s390_idle_data));
Akinobu Mitad882ba62010-05-26 14:43:34 -07001031 err = sysfs_create_group(&s->kobj, &cpu_online_attr_group);
Heiko Carstens2fc2d1e2007-04-27 16:01:56 +02001032 break;
1033 case CPU_DEAD:
Rafael J. Wysocki8bb78442007-05-09 02:35:10 -07001034 case CPU_DEAD_FROZEN:
Heiko Carstens08d07962008-01-26 14:10:56 +01001035 sysfs_remove_group(&s->kobj, &cpu_online_attr_group);
Heiko Carstens2fc2d1e2007-04-27 16:01:56 +02001036 break;
1037 }
Akinobu Mitad882ba62010-05-26 14:43:34 -07001038 return notifier_from_errno(err);
Heiko Carstens2fc2d1e2007-04-27 16:01:56 +02001039}
1040
1041static struct notifier_block __cpuinitdata smp_cpu_nb = {
Heiko Carstens39ce0102007-04-27 16:02:00 +02001042 .notifier_call = smp_cpu_notify,
Heiko Carstens2fc2d1e2007-04-27 16:01:56 +02001043};
1044
Heiko Carstens2bc89b52008-02-05 16:50:40 +01001045static int __devinit smp_add_present_cpu(int cpu)
Heiko Carstens08d07962008-01-26 14:10:56 +01001046{
1047 struct cpu *c = &per_cpu(cpu_devices, cpu);
1048 struct sys_device *s = &c->sysdev;
1049 int rc;
1050
1051 c->hotpluggable = 1;
1052 rc = register_cpu(c, cpu);
1053 if (rc)
1054 goto out;
1055 rc = sysfs_create_group(&s->kobj, &cpu_common_attr_group);
1056 if (rc)
1057 goto out_cpu;
1058 if (!cpu_online(cpu))
1059 goto out;
1060 rc = sysfs_create_group(&s->kobj, &cpu_online_attr_group);
1061 if (!rc)
1062 return 0;
1063 sysfs_remove_group(&s->kobj, &cpu_common_attr_group);
1064out_cpu:
1065#ifdef CONFIG_HOTPLUG_CPU
1066 unregister_cpu(c);
1067#endif
1068out:
1069 return rc;
1070}
1071
1072#ifdef CONFIG_HOTPLUG_CPU
Heiko Carstens1e489512008-04-30 13:38:37 +02001073
Heiko Carstens67060d92008-05-30 10:03:27 +02001074int __ref smp_rescan_cpus(void)
Heiko Carstens08d07962008-01-26 14:10:56 +01001075{
1076 cpumask_t newcpus;
1077 int cpu;
1078 int rc;
1079
Martin Schwidefsky9d40d2e2008-01-26 14:11:31 +01001080 get_online_cpus();
Heiko Carstens0b18d312008-04-30 13:38:36 +02001081 mutex_lock(&smp_cpu_state_mutex);
KOSAKI Motohiro0f1959f2011-05-23 10:24:36 +02001082 cpumask_copy(&newcpus, cpu_present_mask);
Heiko Carstens1e489512008-04-30 13:38:37 +02001083 rc = __smp_rescan_cpus();
Heiko Carstens08d07962008-01-26 14:10:56 +01001084 if (rc)
1085 goto out;
KOSAKI Motohiro0f1959f2011-05-23 10:24:36 +02001086 cpumask_andnot(&newcpus, cpu_present_mask, &newcpus);
1087 for_each_cpu(cpu, &newcpus) {
Heiko Carstens08d07962008-01-26 14:10:56 +01001088 rc = smp_add_present_cpu(cpu);
1089 if (rc)
KOSAKI Motohiro0f1959f2011-05-23 10:24:36 +02001090 set_cpu_present(cpu, false);
Heiko Carstens08d07962008-01-26 14:10:56 +01001091 }
1092 rc = 0;
1093out:
Heiko Carstens08d07962008-01-26 14:10:56 +01001094 mutex_unlock(&smp_cpu_state_mutex);
Heiko Carstens0b18d312008-04-30 13:38:36 +02001095 put_online_cpus();
KOSAKI Motohiro0f1959f2011-05-23 10:24:36 +02001096 if (!cpumask_empty(&newcpus))
Heiko Carstensc10fde02008-04-17 07:46:13 +02001097 topology_schedule_update();
Heiko Carstens1e489512008-04-30 13:38:37 +02001098 return rc;
1099}
1100
Andi Kleenc9be0a32010-01-05 12:47:58 +01001101static ssize_t __ref rescan_store(struct sysdev_class *class,
1102 struct sysdev_class_attribute *attr,
1103 const char *buf,
Heiko Carstens1e489512008-04-30 13:38:37 +02001104 size_t count)
1105{
1106 int rc;
1107
1108 rc = smp_rescan_cpus();
Heiko Carstens08d07962008-01-26 14:10:56 +01001109 return rc ? rc : count;
1110}
Heiko Carstensda5aae72008-10-28 11:10:16 +01001111static SYSDEV_CLASS_ATTR(rescan, 0200, NULL, rescan_store);
Heiko Carstens08d07962008-01-26 14:10:56 +01001112#endif /* CONFIG_HOTPLUG_CPU */
1113
Heiko Carstens5fbcae52010-02-12 11:19:24 +01001114static ssize_t dispatching_show(struct sysdev_class *class,
1115 struct sysdev_class_attribute *attr,
1116 char *buf)
Heiko Carstensc10fde02008-04-17 07:46:13 +02001117{
1118 ssize_t count;
1119
1120 mutex_lock(&smp_cpu_state_mutex);
1121 count = sprintf(buf, "%d\n", cpu_management);
1122 mutex_unlock(&smp_cpu_state_mutex);
1123 return count;
1124}
1125
Andi Kleenc9be0a32010-01-05 12:47:58 +01001126static ssize_t dispatching_store(struct sysdev_class *dev,
1127 struct sysdev_class_attribute *attr,
1128 const char *buf,
Heiko Carstensda5aae72008-10-28 11:10:16 +01001129 size_t count)
Heiko Carstensc10fde02008-04-17 07:46:13 +02001130{
1131 int val, rc;
1132 char delim;
1133
1134 if (sscanf(buf, "%d %c", &val, &delim) != 1)
1135 return -EINVAL;
1136 if (val != 0 && val != 1)
1137 return -EINVAL;
1138 rc = 0;
Heiko Carstensc10fde02008-04-17 07:46:13 +02001139 get_online_cpus();
Heiko Carstens0b18d312008-04-30 13:38:36 +02001140 mutex_lock(&smp_cpu_state_mutex);
Heiko Carstensc10fde02008-04-17 07:46:13 +02001141 if (cpu_management == val)
1142 goto out;
1143 rc = topology_set_cpu_management(val);
1144 if (!rc)
1145 cpu_management = val;
1146out:
Heiko Carstensc10fde02008-04-17 07:46:13 +02001147 mutex_unlock(&smp_cpu_state_mutex);
Heiko Carstens0b18d312008-04-30 13:38:36 +02001148 put_online_cpus();
Heiko Carstensc10fde02008-04-17 07:46:13 +02001149 return rc ? rc : count;
1150}
Heiko Carstensda5aae72008-10-28 11:10:16 +01001151static SYSDEV_CLASS_ATTR(dispatching, 0644, dispatching_show,
1152 dispatching_store);
Heiko Carstensc10fde02008-04-17 07:46:13 +02001153
Linus Torvalds1da177e2005-04-16 15:20:36 -07001154static int __init topology_init(void)
1155{
1156 int cpu;
Heiko Carstensfae8b222007-10-22 12:52:39 +02001157 int rc;
Heiko Carstens2fc2d1e2007-04-27 16:01:56 +02001158
1159 register_cpu_notifier(&smp_cpu_nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001160
Heiko Carstens08d07962008-01-26 14:10:56 +01001161#ifdef CONFIG_HOTPLUG_CPU
Heiko Carstensda5aae72008-10-28 11:10:16 +01001162 rc = sysdev_class_create_file(&cpu_sysdev_class, &attr_rescan);
Heiko Carstens08d07962008-01-26 14:10:56 +01001163 if (rc)
1164 return rc;
1165#endif
Heiko Carstensda5aae72008-10-28 11:10:16 +01001166 rc = sysdev_class_create_file(&cpu_sysdev_class, &attr_dispatching);
Heiko Carstensc10fde02008-04-17 07:46:13 +02001167 if (rc)
1168 return rc;
Heiko Carstens08d07962008-01-26 14:10:56 +01001169 for_each_present_cpu(cpu) {
1170 rc = smp_add_present_cpu(cpu);
Heiko Carstensfae8b222007-10-22 12:52:39 +02001171 if (rc)
1172 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001173 }
1174 return 0;
1175}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001176subsys_initcall(topology_init);