cpu.c 46.5 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12
/* CPU control.
 * (C) 2001, 2002, 2003, 2004 Rusty Russell
 *
 * This code is licenced under the GPL.
 */
#include <linux/proc_fs.h>
#include <linux/smp.h>
#include <linux/init.h>
#include <linux/notifier.h>
#include <linux/sched.h>
#include <linux/unistd.h>
#include <linux/cpu.h>
13 14
#include <linux/oom.h>
#include <linux/rcupdate.h>
15
#include <linux/export.h>
16
#include <linux/bug.h>
L
Linus Torvalds 已提交
17 18
#include <linux/kthread.h>
#include <linux/stop_machine.h>
19
#include <linux/mutex.h>
20
#include <linux/gfp.h>
21
#include <linux/suspend.h>
22
#include <linux/lockdep.h>
23
#include <linux/tick.h>
24
#include <linux/irq.h>
25
#include <linux/smpboot.h>
26

27
#include <trace/events/power.h>
28 29
#define CREATE_TRACE_POINTS
#include <trace/events/cpuhp.h>
L
Linus Torvalds 已提交
30

31 32
#include "smpboot.h"

33 34 35 36
/**
 * cpuhp_cpu_state - Per cpu hotplug state storage
 * @state:	The current cpu state
 * @target:	The target state
37 38
 * @thread:	Pointer to the hotplug thread
 * @should_run:	Thread should execute
39
 * @rollback:	Perform a rollback
40 41 42
 * @single:	Single callback invocation
 * @bringup:	Single callback bringup or teardown selector
 * @cb_state:	The state for a single callback (install/uninstall)
43 44
 * @result:	Result of the operation
 * @done:	Signal completion to the issuer of the task
45 46 47 48
 */
struct cpuhp_cpu_state {
	enum cpuhp_state	state;
	enum cpuhp_state	target;
49 50 51
#ifdef CONFIG_SMP
	struct task_struct	*thread;
	bool			should_run;
52
	bool			rollback;
53 54
	bool			single;
	bool			bringup;
55
	struct hlist_node	*node;
56 57 58 59
	enum cpuhp_state	cb_state;
	int			result;
	struct completion	done;
#endif
60 61 62 63 64 65 66 67 68 69 70
};

static DEFINE_PER_CPU(struct cpuhp_cpu_state, cpuhp_state);

/**
 * cpuhp_step - Hotplug state machine step
 * @name:	Name of the step
 * @startup:	Startup function of the step
 * @teardown:	Teardown function of the step
 * @skip_onerr:	Do not invoke the functions on error rollback
 *		Will go away once the notifiers	are gone
71
 * @cant_stop:	Bringup/teardown can't be stopped at this step
72 73
 */
struct cpuhp_step {
74 75 76 77 78 79 80 81 82 83 84 85 86 87 88
	const char		*name;
	union {
		int		(*startup)(unsigned int cpu);
		int		(*startup_multi)(unsigned int cpu,
						 struct hlist_node *node);
	};
	union {
		int		(*teardown)(unsigned int cpu);
		int		(*teardown_multi)(unsigned int cpu,
						  struct hlist_node *node);
	};
	struct hlist_head	list;
	bool			skip_onerr;
	bool			cant_stop;
	bool			multi_instance;
89 90
};

91
static DEFINE_MUTEX(cpuhp_state_mutex);
92
static struct cpuhp_step cpuhp_bp_states[];
93
static struct cpuhp_step cpuhp_ap_states[];
94

95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111
static bool cpuhp_is_ap_state(enum cpuhp_state state)
{
	/*
	 * The extra check for CPUHP_TEARDOWN_CPU is only for documentation
	 * purposes as that state is handled explicitly in cpu_down.
	 */
	return state > CPUHP_BRINGUP_CPU && state != CPUHP_TEARDOWN_CPU;
}

static struct cpuhp_step *cpuhp_get_step(enum cpuhp_state state)
{
	struct cpuhp_step *sp;

	sp = cpuhp_is_ap_state(state) ? cpuhp_ap_states : cpuhp_bp_states;
	return sp + state;
}

112 113 114 115
/**
 * cpuhp_invoke_callback _ Invoke the callbacks for a given state
 * @cpu:	The cpu for which the callback should be invoked
 * @step:	The step in the state machine
116
 * @bringup:	True if the bringup callback should be invoked
117
 *
118
 * Called from cpu hotplug and from the state register machinery.
119
 */
120
static int cpuhp_invoke_callback(unsigned int cpu, enum cpuhp_state state,
121
				 bool bringup, struct hlist_node *node)
122 123
{
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);
124
	struct cpuhp_step *step = cpuhp_get_step(state);
125 126 127 128 129 130 131 132
	int (*cbm)(unsigned int cpu, struct hlist_node *node);
	int (*cb)(unsigned int cpu);
	int ret, cnt;

	if (!step->multi_instance) {
		cb = bringup ? step->startup : step->teardown;
		if (!cb)
			return 0;
133
		trace_cpuhp_enter(cpu, st->target, state, cb);
134
		ret = cb(cpu);
135
		trace_cpuhp_exit(cpu, st->state, state, ret);
136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170
		return ret;
	}
	cbm = bringup ? step->startup_multi : step->teardown_multi;
	if (!cbm)
		return 0;

	/* Single invocation for instance add/remove */
	if (node) {
		trace_cpuhp_multi_enter(cpu, st->target, state, cbm, node);
		ret = cbm(cpu, node);
		trace_cpuhp_exit(cpu, st->state, state, ret);
		return ret;
	}

	/* State transition. Invoke on all instances */
	cnt = 0;
	hlist_for_each(node, &step->list) {
		trace_cpuhp_multi_enter(cpu, st->target, state, cbm, node);
		ret = cbm(cpu, node);
		trace_cpuhp_exit(cpu, st->state, state, ret);
		if (ret)
			goto err;
		cnt++;
	}
	return 0;
err:
	/* Rollback the instances if one failed */
	cbm = !bringup ? step->startup_multi : step->teardown_multi;
	if (!cbm)
		return ret;

	hlist_for_each(node, &step->list) {
		if (!cnt--)
			break;
		cbm(cpu, node);
171 172 173 174
	}
	return ret;
}

175
#ifdef CONFIG_SMP
176
/* Serializes the updates to cpu_online_mask, cpu_present_mask */
177
static DEFINE_MUTEX(cpu_add_remove_lock);
178 179
bool cpuhp_tasks_frozen;
EXPORT_SYMBOL_GPL(cpuhp_tasks_frozen);
L
Linus Torvalds 已提交
180

181
/*
182 183 184 185 186
 * The following two APIs (cpu_maps_update_begin/done) must be used when
 * attempting to serialize the updates to cpu_online_mask & cpu_present_mask.
 * The APIs cpu_notifier_register_begin/done() must be used to protect CPU
 * hotplug callback (un)registration performed using __register_cpu_notifier()
 * or __unregister_cpu_notifier().
187 188 189 190 191
 */
void cpu_maps_update_begin(void)
{
	mutex_lock(&cpu_add_remove_lock);
}
192
EXPORT_SYMBOL(cpu_notifier_register_begin);
193 194 195 196 197

void cpu_maps_update_done(void)
{
	mutex_unlock(&cpu_add_remove_lock);
}
198
EXPORT_SYMBOL(cpu_notifier_register_done);
199

200
static RAW_NOTIFIER_HEAD(cpu_chain);
L
Linus Torvalds 已提交
201

202 203 204 205 206
/* If set, cpu_up and cpu_down will return -EBUSY and do nothing.
 * Should always be manipulated under cpu_add_remove_lock
 */
static int cpu_hotplug_disabled;

207 208
#ifdef CONFIG_HOTPLUG_CPU

209 210
static struct {
	struct task_struct *active_writer;
211 212 213 214
	/* wait queue to wake up the active_writer */
	wait_queue_head_t wq;
	/* verifies that no writer will get active while readers are active */
	struct mutex lock;
215 216 217 218
	/*
	 * Also blocks the new readers during
	 * an ongoing cpu hotplug operation.
	 */
219
	atomic_t refcount;
220 221 222 223

#ifdef CONFIG_DEBUG_LOCK_ALLOC
	struct lockdep_map dep_map;
#endif
224 225
} cpu_hotplug = {
	.active_writer = NULL,
226
	.wq = __WAIT_QUEUE_HEAD_INITIALIZER(cpu_hotplug.wq),
227
	.lock = __MUTEX_INITIALIZER(cpu_hotplug.lock),
228 229 230
#ifdef CONFIG_DEBUG_LOCK_ALLOC
	.dep_map = {.name = "cpu_hotplug.lock" },
#endif
231
};
232

233 234
/* Lockdep annotations for get/put_online_cpus() and cpu_hotplug_begin/end() */
#define cpuhp_lock_acquire_read() lock_map_acquire_read(&cpu_hotplug.dep_map)
235 236
#define cpuhp_lock_acquire_tryread() \
				  lock_map_acquire_tryread(&cpu_hotplug.dep_map)
237 238 239
#define cpuhp_lock_acquire()      lock_map_acquire(&cpu_hotplug.dep_map)
#define cpuhp_lock_release()      lock_map_release(&cpu_hotplug.dep_map)

240

241
void get_online_cpus(void)
242
{
243 244
	might_sleep();
	if (cpu_hotplug.active_writer == current)
245
		return;
246
	cpuhp_lock_acquire_read();
247
	mutex_lock(&cpu_hotplug.lock);
248
	atomic_inc(&cpu_hotplug.refcount);
249
	mutex_unlock(&cpu_hotplug.lock);
250
}
251
EXPORT_SYMBOL_GPL(get_online_cpus);
252

253
void put_online_cpus(void)
254
{
255 256
	int refcount;

257
	if (cpu_hotplug.active_writer == current)
258
		return;
259

260 261 262 263 264 265
	refcount = atomic_dec_return(&cpu_hotplug.refcount);
	if (WARN_ON(refcount < 0)) /* try to fix things up */
		atomic_inc(&cpu_hotplug.refcount);

	if (refcount <= 0 && waitqueue_active(&cpu_hotplug.wq))
		wake_up(&cpu_hotplug.wq);
266

267
	cpuhp_lock_release();
268

269
}
270
EXPORT_SYMBOL_GPL(put_online_cpus);
271

272 273 274 275 276 277 278
/*
 * This ensures that the hotplug operation can begin only when the
 * refcount goes to zero.
 *
 * Note that during a cpu-hotplug operation, the new readers, if any,
 * will be blocked by the cpu_hotplug.lock
 *
279 280
 * Since cpu_hotplug_begin() is always called after invoking
 * cpu_maps_update_begin(), we can be sure that only one writer is active.
281 282 283 284 285 286 287 288 289 290
 *
 * Note that theoretically, there is a possibility of a livelock:
 * - Refcount goes to zero, last reader wakes up the sleeping
 *   writer.
 * - Last reader unlocks the cpu_hotplug.lock.
 * - A new reader arrives at this moment, bumps up the refcount.
 * - The writer acquires the cpu_hotplug.lock finds the refcount
 *   non zero and goes to sleep again.
 *
 * However, this is very difficult to achieve in practice since
291
 * get_online_cpus() not an api which is called all that often.
292 293
 *
 */
294
void cpu_hotplug_begin(void)
295
{
296
	DEFINE_WAIT(wait);
297

298
	cpu_hotplug.active_writer = current;
299
	cpuhp_lock_acquire();
300

301 302
	for (;;) {
		mutex_lock(&cpu_hotplug.lock);
303 304 305
		prepare_to_wait(&cpu_hotplug.wq, &wait, TASK_UNINTERRUPTIBLE);
		if (likely(!atomic_read(&cpu_hotplug.refcount)))
				break;
306 307 308
		mutex_unlock(&cpu_hotplug.lock);
		schedule();
	}
309
	finish_wait(&cpu_hotplug.wq, &wait);
310 311
}

312
void cpu_hotplug_done(void)
313 314 315
{
	cpu_hotplug.active_writer = NULL;
	mutex_unlock(&cpu_hotplug.lock);
316
	cpuhp_lock_release();
317
}
318

319 320 321 322 323 324 325 326 327 328
/*
 * Wait for currently running CPU hotplug operations to complete (if any) and
 * disable future CPU hotplug (from sysfs). The 'cpu_add_remove_lock' protects
 * the 'cpu_hotplug_disabled' flag. The same lock is also acquired by the
 * hotplug path before performing hotplug operations. So acquiring that lock
 * guarantees mutual exclusion from any currently running hotplug operations.
 */
void cpu_hotplug_disable(void)
{
	cpu_maps_update_begin();
329
	cpu_hotplug_disabled++;
330 331
	cpu_maps_update_done();
}
332
EXPORT_SYMBOL_GPL(cpu_hotplug_disable);
333 334 335 336

void cpu_hotplug_enable(void)
{
	cpu_maps_update_begin();
337
	WARN_ON(--cpu_hotplug_disabled < 0);
338 339
	cpu_maps_update_done();
}
340
EXPORT_SYMBOL_GPL(cpu_hotplug_enable);
341
#endif	/* CONFIG_HOTPLUG_CPU */
342

L
Linus Torvalds 已提交
343
/* Need to know about CPUs going up/down? */
344
int register_cpu_notifier(struct notifier_block *nb)
L
Linus Torvalds 已提交
345
{
346
	int ret;
347
	cpu_maps_update_begin();
348
	ret = raw_notifier_chain_register(&cpu_chain, nb);
349
	cpu_maps_update_done();
350
	return ret;
L
Linus Torvalds 已提交
351
}
352

353
int __register_cpu_notifier(struct notifier_block *nb)
354 355 356 357
{
	return raw_notifier_chain_register(&cpu_chain, nb);
}

358
static int __cpu_notify(unsigned long val, unsigned int cpu, int nr_to_call,
359 360
			int *nr_calls)
{
361 362 363
	unsigned long mod = cpuhp_tasks_frozen ? CPU_TASKS_FROZEN : 0;
	void *hcpu = (void *)(long)cpu;

364 365
	int ret;

366
	ret = __raw_notifier_call_chain(&cpu_chain, val | mod, hcpu, nr_to_call,
367
					nr_calls);
368 369

	return notifier_to_errno(ret);
370 371
}

372
static int cpu_notify(unsigned long val, unsigned int cpu)
373
{
374
	return __cpu_notify(val, cpu, -1, NULL);
375 376
}

377 378 379 380 381
static void cpu_notify_nofail(unsigned long val, unsigned int cpu)
{
	BUG_ON(cpu_notify(val, cpu));
}

382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403
/* Notifier wrappers for transitioning to state machine */
static int notify_prepare(unsigned int cpu)
{
	int nr_calls = 0;
	int ret;

	ret = __cpu_notify(CPU_UP_PREPARE, cpu, -1, &nr_calls);
	if (ret) {
		nr_calls--;
		printk(KERN_WARNING "%s: attempt to bring up CPU %u failed\n",
				__func__, cpu);
		__cpu_notify(CPU_UP_CANCELED, cpu, nr_calls, NULL);
	}
	return ret;
}

static int notify_online(unsigned int cpu)
{
	cpu_notify(CPU_ONLINE, cpu);
	return 0;
}

404 405 406 407 408 409
static int notify_starting(unsigned int cpu)
{
	cpu_notify(CPU_STARTING, cpu);
	return 0;
}

410 411 412 413 414 415 416 417
static int bringup_wait_for_ap(unsigned int cpu)
{
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);

	wait_for_completion(&st->done);
	return st->result;
}

418 419 420 421 422
static int bringup_cpu(unsigned int cpu)
{
	struct task_struct *idle = idle_thread_get(cpu);
	int ret;

423 424 425 426 427 428 429
	/*
	 * Some architectures have to walk the irq descriptors to
	 * setup the vector space for the cpu which comes online.
	 * Prevent irq alloc/free across the bringup.
	 */
	irq_lock_sparse();

430 431
	/* Arch-specific enabling code. */
	ret = __cpu_up(cpu, idle);
432
	irq_unlock_sparse();
433 434 435 436
	if (ret) {
		cpu_notify(CPU_UP_CANCELED, cpu);
		return ret;
	}
437
	ret = bringup_wait_for_ap(cpu);
438
	BUG_ON(!cpu_online(cpu));
439
	return ret;
440 441
}

442 443 444
/*
 * Hotplug state machine related functions
 */
445
static void undo_cpu_down(unsigned int cpu, struct cpuhp_cpu_state *st)
446 447
{
	for (st->state++; st->state < st->target; st->state++) {
448
		struct cpuhp_step *step = cpuhp_get_step(st->state);
449 450

		if (!step->skip_onerr)
451
			cpuhp_invoke_callback(cpu, st->state, true, NULL);
452 453 454 455
	}
}

static int cpuhp_down_callbacks(unsigned int cpu, struct cpuhp_cpu_state *st,
456
				enum cpuhp_state target)
457 458 459 460 461
{
	enum cpuhp_state prev_state = st->state;
	int ret = 0;

	for (; st->state > target; st->state--) {
462
		ret = cpuhp_invoke_callback(cpu, st->state, false, NULL);
463 464
		if (ret) {
			st->target = prev_state;
465
			undo_cpu_down(cpu, st);
466 467 468 469 470 471
			break;
		}
	}
	return ret;
}

472
static void undo_cpu_up(unsigned int cpu, struct cpuhp_cpu_state *st)
473 474
{
	for (st->state--; st->state > st->target; st->state--) {
475
		struct cpuhp_step *step = cpuhp_get_step(st->state);
476 477

		if (!step->skip_onerr)
478
			cpuhp_invoke_callback(cpu, st->state, false, NULL);
479 480 481 482
	}
}

static int cpuhp_up_callbacks(unsigned int cpu, struct cpuhp_cpu_state *st,
483
			      enum cpuhp_state target)
484 485 486 487 488 489
{
	enum cpuhp_state prev_state = st->state;
	int ret = 0;

	while (st->state < target) {
		st->state++;
490
		ret = cpuhp_invoke_callback(cpu, st->state, true, NULL);
491 492
		if (ret) {
			st->target = prev_state;
493
			undo_cpu_up(cpu, st);
494 495 496 497 498 499
			break;
		}
	}
	return ret;
}

500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519
/*
 * The cpu hotplug threads manage the bringup and teardown of the cpus
 */
static void cpuhp_create(unsigned int cpu)
{
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);

	init_completion(&st->done);
}

static int cpuhp_should_run(unsigned int cpu)
{
	struct cpuhp_cpu_state *st = this_cpu_ptr(&cpuhp_state);

	return st->should_run;
}

/* Execute the teardown callbacks. Used to be CPU_DOWN_PREPARE */
static int cpuhp_ap_offline(unsigned int cpu, struct cpuhp_cpu_state *st)
{
520
	enum cpuhp_state target = max((int)st->target, CPUHP_TEARDOWN_CPU);
521

522
	return cpuhp_down_callbacks(cpu, st, target);
523 524 525 526 527
}

/* Execute the online startup callbacks. Used to be CPU_ONLINE */
static int cpuhp_ap_online(unsigned int cpu, struct cpuhp_cpu_state *st)
{
528
	return cpuhp_up_callbacks(cpu, st, st->target);
529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550
}

/*
 * Execute teardown/startup callbacks on the plugged cpu. Also used to invoke
 * callbacks when a state gets [un]installed at runtime.
 */
static void cpuhp_thread_fun(unsigned int cpu)
{
	struct cpuhp_cpu_state *st = this_cpu_ptr(&cpuhp_state);
	int ret = 0;

	/*
	 * Paired with the mb() in cpuhp_kick_ap_work and
	 * cpuhp_invoke_ap_callback, so the work set is consistent visible.
	 */
	smp_mb();
	if (!st->should_run)
		return;

	st->should_run = false;

	/* Single callback invocation for [un]install ? */
551
	if (st->single) {
552 553
		if (st->cb_state < CPUHP_AP_ONLINE) {
			local_irq_disable();
554
			ret = cpuhp_invoke_callback(cpu, st->cb_state,
555
						    st->bringup, st->node);
556 557
			local_irq_enable();
		} else {
558
			ret = cpuhp_invoke_callback(cpu, st->cb_state,
559
						    st->bringup, st->node);
560
		}
561 562 563
	} else if (st->rollback) {
		BUG_ON(st->state < CPUHP_AP_ONLINE_IDLE);

564
		undo_cpu_down(cpu, st);
565 566 567 568 569 570
		/*
		 * This is a momentary workaround to keep the notifier users
		 * happy. Will go away once we got rid of the notifiers.
		 */
		cpu_notify_nofail(CPU_DOWN_FAILED, cpu);
		st->rollback = false;
571
	} else {
572
		/* Cannot happen .... */
573
		BUG_ON(st->state < CPUHP_AP_ONLINE_IDLE);
574

575 576 577 578 579 580 581 582 583 584 585
		/* Regular hotplug work */
		if (st->state < st->target)
			ret = cpuhp_ap_online(cpu, st);
		else if (st->state > st->target)
			ret = cpuhp_ap_offline(cpu, st);
	}
	st->result = ret;
	complete(&st->done);
}

/* Invoke a single callback on a remote cpu */
586
static int
587 588
cpuhp_invoke_ap_callback(int cpu, enum cpuhp_state state, bool bringup,
			 struct hlist_node *node)
589 590 591 592 593 594
{
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);

	if (!cpu_online(cpu))
		return 0;

595 596 597 598 599
	/*
	 * If we are up and running, use the hotplug thread. For early calls
	 * we invoke the thread function directly.
	 */
	if (!st->thread)
600
		return cpuhp_invoke_callback(cpu, state, bringup, node);
601

602
	st->cb_state = state;
603 604
	st->single = true;
	st->bringup = bringup;
605
	st->node = node;
606

607 608 609 610 611 612 613 614 615 616 617 618
	/*
	 * Make sure the above stores are visible before should_run becomes
	 * true. Paired with the mb() above in cpuhp_thread_fun()
	 */
	smp_mb();
	st->should_run = true;
	wake_up_process(st->thread);
	wait_for_completion(&st->done);
	return st->result;
}

/* Regular hotplug invocation of the AP hotplug thread */
619
static void __cpuhp_kick_ap_work(struct cpuhp_cpu_state *st)
620 621
{
	st->result = 0;
622
	st->single = false;
623 624 625 626 627 628 629
	/*
	 * Make sure the above stores are visible before should_run becomes
	 * true. Paired with the mb() above in cpuhp_thread_fun()
	 */
	smp_mb();
	st->should_run = true;
	wake_up_process(st->thread);
630 631 632 633 634 635 636 637 638
}

static int cpuhp_kick_ap_work(unsigned int cpu)
{
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);
	enum cpuhp_state state = st->state;

	trace_cpuhp_enter(cpu, st->target, state, cpuhp_kick_ap_work);
	__cpuhp_kick_ap_work(st);
639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658
	wait_for_completion(&st->done);
	trace_cpuhp_exit(cpu, st->state, state, st->result);
	return st->result;
}

static struct smp_hotplug_thread cpuhp_threads = {
	.store			= &cpuhp_state.thread,
	.create			= &cpuhp_create,
	.thread_should_run	= cpuhp_should_run,
	.thread_fn		= cpuhp_thread_fun,
	.thread_comm		= "cpuhp/%u",
	.selfparking		= true,
};

void __init cpuhp_threads_init(void)
{
	BUG_ON(smpboot_register_percpu_thread(&cpuhp_threads));
	kthread_unpark(this_cpu_read(cpuhp_state.thread));
}

659
#ifdef CONFIG_HOTPLUG_CPU
L
Linus Torvalds 已提交
660
EXPORT_SYMBOL(register_cpu_notifier);
661
EXPORT_SYMBOL(__register_cpu_notifier);
662
void unregister_cpu_notifier(struct notifier_block *nb)
L
Linus Torvalds 已提交
663
{
664
	cpu_maps_update_begin();
665
	raw_notifier_chain_unregister(&cpu_chain, nb);
666
	cpu_maps_update_done();
L
Linus Torvalds 已提交
667 668 669
}
EXPORT_SYMBOL(unregister_cpu_notifier);

670
void __unregister_cpu_notifier(struct notifier_block *nb)
671 672 673 674 675
{
	raw_notifier_chain_unregister(&cpu_chain, nb);
}
EXPORT_SYMBOL(__unregister_cpu_notifier);

676 677 678 679 680 681 682 683 684 685 686 687
/**
 * clear_tasks_mm_cpumask - Safely clear tasks' mm_cpumask for a CPU
 * @cpu: a CPU id
 *
 * This function walks all processes, finds a valid mm struct for each one and
 * then clears a corresponding bit in mm's cpumask.  While this all sounds
 * trivial, there are various non-obvious corner cases, which this function
 * tries to solve in a safe manner.
 *
 * Also note that the function uses a somewhat relaxed locking scheme, so it may
 * be called only for an already offlined CPU.
 */
688 689 690 691 692 693 694 695 696 697 698
void clear_tasks_mm_cpumask(int cpu)
{
	struct task_struct *p;

	/*
	 * This function is called after the cpu is taken down and marked
	 * offline, so its not like new tasks will ever get this cpu set in
	 * their mm mask. -- Peter Zijlstra
	 * Thus, we may use rcu_read_lock() here, instead of grabbing
	 * full-fledged tasklist_lock.
	 */
699
	WARN_ON(cpu_online(cpu));
700 701 702 703
	rcu_read_lock();
	for_each_process(p) {
		struct task_struct *t;

704 705 706 707
		/*
		 * Main thread might exit, but other threads may still have
		 * a valid mm. Find one.
		 */
708 709 710 711 712 713 714 715 716
		t = find_lock_task_mm(p);
		if (!t)
			continue;
		cpumask_clear_cpu(cpu, mm_cpumask(t->mm));
		task_unlock(t);
	}
	rcu_read_unlock();
}

K
Kirill Tkhai 已提交
717
static inline void check_for_tasks(int dead_cpu)
L
Linus Torvalds 已提交
718
{
K
Kirill Tkhai 已提交
719
	struct task_struct *g, *p;
L
Linus Torvalds 已提交
720

721 722
	read_lock(&tasklist_lock);
	for_each_process_thread(g, p) {
K
Kirill Tkhai 已提交
723 724 725 726 727 728 729 730 731 732 733 734 735 736
		if (!p->on_rq)
			continue;
		/*
		 * We do the check with unlocked task_rq(p)->lock.
		 * Order the reading to do not warn about a task,
		 * which was running on this cpu in the past, and
		 * it's just been woken on another cpu.
		 */
		rmb();
		if (task_cpu(p) != dead_cpu)
			continue;

		pr_warn("Task %s (pid=%d) is on cpu %d (state=%ld, flags=%x)\n",
			p->comm, task_pid_nr(p), dead_cpu, p->state, p->flags);
737 738
	}
	read_unlock(&tasklist_lock);
L
Linus Torvalds 已提交
739 740
}

741 742 743 744 745 746 747 748 749 750 751 752 753 754
static int notify_down_prepare(unsigned int cpu)
{
	int err, nr_calls = 0;

	err = __cpu_notify(CPU_DOWN_PREPARE, cpu, -1, &nr_calls);
	if (err) {
		nr_calls--;
		__cpu_notify(CPU_DOWN_FAILED, cpu, nr_calls, NULL);
		pr_warn("%s: attempt to take down CPU %u failed\n",
				__func__, cpu);
	}
	return err;
}

755 756 757 758 759 760
static int notify_dying(unsigned int cpu)
{
	cpu_notify(CPU_DYING, cpu);
	return 0;
}

L
Linus Torvalds 已提交
761
/* Take this CPU down. */
762
static int take_cpu_down(void *_param)
L
Linus Torvalds 已提交
763
{
764 765
	struct cpuhp_cpu_state *st = this_cpu_ptr(&cpuhp_state);
	enum cpuhp_state target = max((int)st->target, CPUHP_AP_OFFLINE);
766
	int err, cpu = smp_processor_id();
L
Linus Torvalds 已提交
767 768 769 770

	/* Ensure this CPU doesn't handle any more interrupts. */
	err = __cpu_disable();
	if (err < 0)
Z
Zwane Mwaikambo 已提交
771
		return err;
L
Linus Torvalds 已提交
772

773 774 775 776 777 778
	/*
	 * We get here while we are in CPUHP_TEARDOWN_CPU state and we must not
	 * do this step again.
	 */
	WARN_ON(st->state != CPUHP_TEARDOWN_CPU);
	st->state--;
779
	/* Invoke the former CPU_DYING callbacks */
780
	for (; st->state > target; st->state--)
781
		cpuhp_invoke_callback(cpu, st->state, false, NULL);
782

783 784
	/* Give up timekeeping duties */
	tick_handover_do_timer();
785
	/* Park the stopper thread */
786
	stop_machine_park(cpu);
Z
Zwane Mwaikambo 已提交
787
	return 0;
L
Linus Torvalds 已提交
788 789
}

790
static int takedown_cpu(unsigned int cpu)
L
Linus Torvalds 已提交
791
{
792
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);
793
	int err;
L
Linus Torvalds 已提交
794

795
	/* Park the smpboot threads */
796
	kthread_park(per_cpu_ptr(&cpuhp_state, cpu)->thread);
797
	smpboot_park_threads(cpu);
798

799
	/*
800 801
	 * Prevent irq alloc/free while the dying cpu reorganizes the
	 * interrupt affinities.
802
	 */
803
	irq_lock_sparse();
804

805 806 807
	/*
	 * So now all preempt/rcu users must observe !cpu_active().
	 */
808
	err = stop_machine(take_cpu_down, NULL, cpumask_of(cpu));
809
	if (err) {
810
		/* CPU refused to die */
811
		irq_unlock_sparse();
812 813
		/* Unpark the hotplug thread so we can rollback there */
		kthread_unpark(per_cpu_ptr(&cpuhp_state, cpu)->thread);
814
		return err;
815
	}
816
	BUG_ON(cpu_online(cpu));
L
Linus Torvalds 已提交
817

818 819 820 821
	/*
	 * The migration_call() CPU_DYING callback will have removed all
	 * runnable tasks from the cpu, there's only the idle task left now
	 * that the migration thread is done doing the stop_machine thing.
P
Peter Zijlstra 已提交
822 823
	 *
	 * Wait for the stop thread to go away.
824
	 */
825 826
	wait_for_completion(&st->done);
	BUG_ON(st->state != CPUHP_AP_IDLE_DEAD);
L
Linus Torvalds 已提交
827

828 829 830
	/* Interrupts are moved away from the dying cpu, reenable alloc/free */
	irq_unlock_sparse();

831
	hotplug_cpu__broadcast_tick_pull(cpu);
L
Linus Torvalds 已提交
832 833 834
	/* This actually kills the CPU. */
	__cpu_die(cpu);

835
	tick_cleanup_dead_cpu(cpu);
836 837
	return 0;
}
L
Linus Torvalds 已提交
838

839 840 841
static int notify_dead(unsigned int cpu)
{
	cpu_notify_nofail(CPU_DEAD, cpu);
L
Linus Torvalds 已提交
842
	check_for_tasks(cpu);
843 844 845
	return 0;
}

846 847 848 849 850 851 852
static void cpuhp_complete_idle_dead(void *arg)
{
	struct cpuhp_cpu_state *st = arg;

	complete(&st->done);
}

853 854 855 856 857
void cpuhp_report_idle_dead(void)
{
	struct cpuhp_cpu_state *st = this_cpu_ptr(&cpuhp_state);

	BUG_ON(st->state != CPUHP_AP_OFFLINE);
858
	rcu_report_dead(smp_processor_id());
859 860 861 862 863 864 865
	st->state = CPUHP_AP_IDLE_DEAD;
	/*
	 * We cannot call complete after rcu_report_dead() so we delegate it
	 * to an online cpu.
	 */
	smp_call_function_single(cpumask_first(cpu_online_mask),
				 cpuhp_complete_idle_dead, st, 0);
866 867
}

868 869 870 871
#else
#define notify_down_prepare	NULL
#define takedown_cpu		NULL
#define notify_dead		NULL
872
#define notify_dying		NULL
873 874 875 876
#endif

#ifdef CONFIG_HOTPLUG_CPU

877
/* Requires cpu_add_remove_lock to be held */
878 879
static int __ref _cpu_down(unsigned int cpu, int tasks_frozen,
			   enum cpuhp_state target)
880
{
881 882 883
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);
	int prev_state, ret = 0;
	bool hasdied = false;
884 885 886 887

	if (num_online_cpus() == 1)
		return -EBUSY;

888
	if (!cpu_present(cpu))
889 890 891 892 893 894
		return -EINVAL;

	cpu_hotplug_begin();

	cpuhp_tasks_frozen = tasks_frozen;

895
	prev_state = st->state;
896
	st->target = target;
897 898 899 900
	/*
	 * If the current CPU state is in the range of the AP hotplug thread,
	 * then we need to kick the thread.
	 */
901
	if (st->state > CPUHP_TEARDOWN_CPU) {
902 903 904 905 906 907 908 909 910 911 912 913
		ret = cpuhp_kick_ap_work(cpu);
		/*
		 * The AP side has done the error rollback already. Just
		 * return the error code..
		 */
		if (ret)
			goto out;

		/*
		 * We might have stopped still in the range of the AP hotplug
		 * thread. Nothing to do anymore.
		 */
914
		if (st->state > CPUHP_TEARDOWN_CPU)
915 916 917
			goto out;
	}
	/*
918
	 * The AP brought itself down to CPUHP_TEARDOWN_CPU. So we need
919 920
	 * to do the further cleanups.
	 */
921
	ret = cpuhp_down_callbacks(cpu, st, target);
922 923 924 925 926
	if (ret && st->state > CPUHP_TEARDOWN_CPU && st->state < prev_state) {
		st->target = prev_state;
		st->rollback = true;
		cpuhp_kick_ap_work(cpu);
	}
927

928
	hasdied = prev_state != st->state && st->state == CPUHP_OFFLINE;
929
out:
930
	cpu_hotplug_done();
931 932
	/* This post dead nonsense must die */
	if (!ret && hasdied)
933
		cpu_notify_nofail(CPU_POST_DEAD, cpu);
934
	return ret;
935 936
}

937
static int do_cpu_down(unsigned int cpu, enum cpuhp_state target)
938
{
939
	int err;
940

941
	cpu_maps_update_begin();
942 943

	if (cpu_hotplug_disabled) {
944
		err = -EBUSY;
945 946 947
		goto out;
	}

948
	err = _cpu_down(cpu, 0, target);
949

950
out:
951
	cpu_maps_update_done();
L
Linus Torvalds 已提交
952 953
	return err;
}
954 955 956 957
int cpu_down(unsigned int cpu)
{
	return do_cpu_down(cpu, CPUHP_OFFLINE);
}
958
EXPORT_SYMBOL(cpu_down);
L
Linus Torvalds 已提交
959 960
#endif /*CONFIG_HOTPLUG_CPU*/

961 962 963 964 965 966 967 968 969 970 971 972 973 974 975
/**
 * notify_cpu_starting(cpu) - call the CPU_STARTING notifiers
 * @cpu: cpu that just started
 *
 * This function calls the cpu_chain notifiers with CPU_STARTING.
 * It must be called by the arch code on the new cpu, before the new cpu
 * enables interrupts and before the "boot" cpu returns from __cpu_up().
 */
void notify_cpu_starting(unsigned int cpu)
{
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);
	enum cpuhp_state target = min((int)st->target, CPUHP_AP_ONLINE);

	while (st->state < target) {
		st->state++;
976
		cpuhp_invoke_callback(cpu, st->state, true, NULL);
977 978 979
	}
}

980 981
/*
 * Called from the idle task. We need to set active here, so we can kick off
982 983 984
 * the stopper thread and unpark the smpboot threads. If the target state is
 * beyond CPUHP_AP_ONLINE_IDLE we kick cpuhp thread and let it bring up the
 * cpu further.
985
 */
986
void cpuhp_online_idle(enum cpuhp_state state)
987
{
988 989 990 991 992 993 994 995
	struct cpuhp_cpu_state *st = this_cpu_ptr(&cpuhp_state);
	unsigned int cpu = smp_processor_id();

	/* Happens for the boot cpu */
	if (state != CPUHP_AP_ONLINE_IDLE)
		return;

	st->state = CPUHP_AP_ONLINE_IDLE;
996

997
	/* Unpark the stopper thread and the hotplug thread of this cpu */
998
	stop_machine_unpark(cpu);
999
	kthread_unpark(st->thread);
1000 1001 1002 1003 1004 1005

	/* Should we go further up ? */
	if (st->target > CPUHP_AP_ONLINE_IDLE)
		__cpuhp_kick_ap_work(st);
	else
		complete(&st->done);
1006 1007
}

1008
/* Requires cpu_add_remove_lock to be held */
1009
static int _cpu_up(unsigned int cpu, int tasks_frozen, enum cpuhp_state target)
L
Linus Torvalds 已提交
1010
{
1011
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);
1012
	struct task_struct *idle;
1013
	int ret = 0;
L
Linus Torvalds 已提交
1014

1015
	cpu_hotplug_begin();
1016

1017
	if (!cpu_present(cpu)) {
1018 1019 1020 1021
		ret = -EINVAL;
		goto out;
	}

1022 1023 1024 1025 1026
	/*
	 * The caller of do_cpu_up might have raced with another
	 * caller. Ignore it for now.
	 */
	if (st->state >= target)
1027
		goto out;
1028 1029 1030 1031 1032 1033 1034 1035

	if (st->state == CPUHP_OFFLINE) {
		/* Let it fail before we try to bring the cpu up */
		idle = idle_thread_get(cpu);
		if (IS_ERR(idle)) {
			ret = PTR_ERR(idle);
			goto out;
		}
1036
	}
1037

1038 1039
	cpuhp_tasks_frozen = tasks_frozen;

1040
	st->target = target;
1041 1042 1043 1044
	/*
	 * If the current CPU state is in the range of the AP hotplug thread,
	 * then we need to kick the thread once more.
	 */
1045
	if (st->state > CPUHP_BRINGUP_CPU) {
1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056
		ret = cpuhp_kick_ap_work(cpu);
		/*
		 * The AP side has done the error rollback already. Just
		 * return the error code..
		 */
		if (ret)
			goto out;
	}

	/*
	 * Try to reach the target state. We max out on the BP at
1057
	 * CPUHP_BRINGUP_CPU. After that the AP hotplug thread is
1058 1059
	 * responsible for bringing it up to the target state.
	 */
1060
	target = min((int)target, CPUHP_BRINGUP_CPU);
1061
	ret = cpuhp_up_callbacks(cpu, st, target);
1062
out:
1063
	cpu_hotplug_done();
1064 1065 1066
	return ret;
}

1067
static int do_cpu_up(unsigned int cpu, enum cpuhp_state target)
1068 1069
{
	int err = 0;
1070

R
Rusty Russell 已提交
1071
	if (!cpu_possible(cpu)) {
1072 1073
		pr_err("can't online cpu %d because it is not configured as may-hotadd at boot time\n",
		       cpu);
1074
#if defined(CONFIG_IA64)
1075
		pr_err("please check additional_cpus= boot parameter\n");
1076 1077 1078
#endif
		return -EINVAL;
	}
1079

1080 1081 1082
	err = try_online_node(cpu_to_node(cpu));
	if (err)
		return err;
1083

1084
	cpu_maps_update_begin();
1085 1086

	if (cpu_hotplug_disabled) {
1087
		err = -EBUSY;
1088 1089 1090
		goto out;
	}

1091
	err = _cpu_up(cpu, 0, target);
1092
out:
1093
	cpu_maps_update_done();
1094 1095
	return err;
}
1096 1097 1098 1099 1100

int cpu_up(unsigned int cpu)
{
	return do_cpu_up(cpu, CPUHP_ONLINE);
}
P
Paul E. McKenney 已提交
1101
EXPORT_SYMBOL_GPL(cpu_up);
1102

1103
#ifdef CONFIG_PM_SLEEP_SMP
R
Rusty Russell 已提交
1104
static cpumask_var_t frozen_cpus;
1105 1106 1107

int disable_nonboot_cpus(void)
{
1108
	int cpu, first_cpu, error = 0;
1109

1110
	cpu_maps_update_begin();
R
Rusty Russell 已提交
1111
	first_cpu = cpumask_first(cpu_online_mask);
1112 1113
	/*
	 * We take down all of the non-boot CPUs in one shot to avoid races
1114 1115
	 * with the userspace trying to use the CPU hotplug at the same time
	 */
R
Rusty Russell 已提交
1116
	cpumask_clear(frozen_cpus);
1117

1118
	pr_info("Disabling non-boot CPUs ...\n");
1119 1120 1121
	for_each_online_cpu(cpu) {
		if (cpu == first_cpu)
			continue;
1122
		trace_suspend_resume(TPS("CPU_OFF"), cpu, true);
1123
		error = _cpu_down(cpu, 1, CPUHP_OFFLINE);
1124
		trace_suspend_resume(TPS("CPU_OFF"), cpu, false);
1125
		if (!error)
R
Rusty Russell 已提交
1126
			cpumask_set_cpu(cpu, frozen_cpus);
1127
		else {
1128
			pr_err("Error taking CPU%d down: %d\n", cpu, error);
1129 1130 1131
			break;
		}
	}
1132

1133
	if (!error)
1134
		BUG_ON(num_online_cpus() > 1);
1135
	else
1136
		pr_err("Non-boot CPUs are not disabled\n");
1137 1138 1139 1140 1141 1142 1143 1144

	/*
	 * Make sure the CPUs won't be enabled by someone else. We need to do
	 * this even in case of failure as all disable_nonboot_cpus() users are
	 * supposed to do enable_nonboot_cpus() on the failure path.
	 */
	cpu_hotplug_disabled++;

1145
	cpu_maps_update_done();
1146 1147 1148
	return error;
}

1149 1150 1151 1152 1153 1154 1155 1156
void __weak arch_enable_nonboot_cpus_begin(void)
{
}

void __weak arch_enable_nonboot_cpus_end(void)
{
}

1157
void enable_nonboot_cpus(void)
1158 1159 1160 1161
{
	int cpu, error;

	/* Allow everyone to use the CPU hotplug again */
1162
	cpu_maps_update_begin();
1163
	WARN_ON(--cpu_hotplug_disabled < 0);
R
Rusty Russell 已提交
1164
	if (cpumask_empty(frozen_cpus))
1165
		goto out;
1166

1167
	pr_info("Enabling non-boot CPUs ...\n");
1168 1169 1170

	arch_enable_nonboot_cpus_begin();

R
Rusty Russell 已提交
1171
	for_each_cpu(cpu, frozen_cpus) {
1172
		trace_suspend_resume(TPS("CPU_ON"), cpu, true);
1173
		error = _cpu_up(cpu, 1, CPUHP_ONLINE);
1174
		trace_suspend_resume(TPS("CPU_ON"), cpu, false);
1175
		if (!error) {
1176
			pr_info("CPU%d is up\n", cpu);
1177 1178
			continue;
		}
1179
		pr_warn("Error taking CPU%d up: %d\n", cpu, error);
1180
	}
1181 1182 1183

	arch_enable_nonboot_cpus_end();

R
Rusty Russell 已提交
1184
	cpumask_clear(frozen_cpus);
1185
out:
1186
	cpu_maps_update_done();
L
Linus Torvalds 已提交
1187
}
R
Rusty Russell 已提交
1188

1189
static int __init alloc_frozen_cpus(void)
R
Rusty Russell 已提交
1190 1191 1192 1193 1194 1195
{
	if (!alloc_cpumask_var(&frozen_cpus, GFP_KERNEL|__GFP_ZERO))
		return -ENOMEM;
	return 0;
}
core_initcall(alloc_frozen_cpus);
1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215

/*
 * When callbacks for CPU hotplug notifications are being executed, we must
 * ensure that the state of the system with respect to the tasks being frozen
 * or not, as reported by the notification, remains unchanged *throughout the
 * duration* of the execution of the callbacks.
 * Hence we need to prevent the freezer from racing with regular CPU hotplug.
 *
 * This synchronization is implemented by mutually excluding regular CPU
 * hotplug and Suspend/Hibernate call paths by hooking onto the Suspend/
 * Hibernate notifications.
 */
static int
cpu_hotplug_pm_callback(struct notifier_block *nb,
			unsigned long action, void *ptr)
{
	switch (action) {

	case PM_SUSPEND_PREPARE:
	case PM_HIBERNATION_PREPARE:
1216
		cpu_hotplug_disable();
1217 1218 1219 1220
		break;

	case PM_POST_SUSPEND:
	case PM_POST_HIBERNATION:
1221
		cpu_hotplug_enable();
1222 1223 1224 1225 1226 1227 1228 1229 1230 1231
		break;

	default:
		return NOTIFY_DONE;
	}

	return NOTIFY_OK;
}


1232
static int __init cpu_hotplug_pm_sync_init(void)
1233
{
1234 1235 1236 1237 1238
	/*
	 * cpu_hotplug_pm_callback has higher priority than x86
	 * bsp_pm_callback which depends on cpu_hotplug_pm_callback
	 * to disable cpu hotplug to avoid cpu hotplug race.
	 */
1239 1240 1241 1242 1243
	pm_notifier(cpu_hotplug_pm_callback, 0);
	return 0;
}
core_initcall(cpu_hotplug_pm_sync_init);

1244
#endif /* CONFIG_PM_SLEEP_SMP */
1245 1246

#endif /* CONFIG_SMP */
1247

1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259
/* Boot processor state steps */
static struct cpuhp_step cpuhp_bp_states[] = {
	[CPUHP_OFFLINE] = {
		.name			= "offline",
		.startup		= NULL,
		.teardown		= NULL,
	},
#ifdef CONFIG_SMP
	[CPUHP_CREATE_THREADS]= {
		.name			= "threads:create",
		.startup		= smpboot_create_threads,
		.teardown		= NULL,
1260
		.cant_stop		= true,
1261
	},
1262 1263 1264 1265 1266
	[CPUHP_PERF_PREPARE] = {
		.name = "perf prepare",
		.startup = perf_event_init_cpu,
		.teardown = perf_event_exit_cpu,
	},
1267 1268 1269 1270 1271
	[CPUHP_WORKQUEUE_PREP] = {
		.name = "workqueue prepare",
		.startup = workqueue_prepare_cpu,
		.teardown = NULL,
	},
1272 1273 1274 1275 1276
	[CPUHP_HRTIMERS_PREPARE] = {
		.name = "hrtimers prepare",
		.startup = hrtimers_prepare_cpu,
		.teardown = hrtimers_dead_cpu,
	},
1277 1278 1279 1280 1281
	[CPUHP_SMPCFD_PREPARE] = {
		.name = "SMPCFD prepare",
		.startup = smpcfd_prepare_cpu,
		.teardown = smpcfd_dead_cpu,
	},
1282 1283 1284 1285 1286
	[CPUHP_RCUTREE_PREP] = {
		.name = "RCU-tree prepare",
		.startup = rcutree_prepare_cpu,
		.teardown = rcutree_dead_cpu,
	},
1287 1288 1289 1290
	/*
	 * Preparatory and dead notifiers. Will be replaced once the notifiers
	 * are converted to states.
	 */
1291 1292 1293 1294 1295
	[CPUHP_NOTIFY_PREPARE] = {
		.name			= "notify:prepare",
		.startup		= notify_prepare,
		.teardown		= notify_dead,
		.skip_onerr		= true,
1296
		.cant_stop		= true,
1297
	},
1298 1299 1300 1301 1302 1303 1304 1305 1306 1307
	/*
	 * On the tear-down path, timers_dead_cpu() must be invoked
	 * before blk_mq_queue_reinit_notify() from notify_dead(),
	 * otherwise a RCU stall occurs.
	 */
	[CPUHP_TIMERS_DEAD] = {
		.name = "timers dead",
		.startup = NULL,
		.teardown = timers_dead_cpu,
	},
1308
	/* Kicks the plugged cpu into life */
1309 1310 1311
	[CPUHP_BRINGUP_CPU] = {
		.name			= "cpu:bringup",
		.startup		= bringup_cpu,
1312
		.teardown		= NULL,
1313
		.cant_stop		= true,
1314
	},
1315 1316 1317 1318
	[CPUHP_AP_SMPCFD_DYING] = {
		.startup = NULL,
		.teardown = smpcfd_dying_cpu,
	},
1319 1320 1321 1322
	/*
	 * Handled on controll processor until the plugged processor manages
	 * this itself.
	 */
1323 1324 1325
	[CPUHP_TEARDOWN_CPU] = {
		.name			= "cpu:teardown",
		.startup		= NULL,
1326
		.teardown		= takedown_cpu,
1327
		.cant_stop		= true,
1328
	},
1329 1330
#else
	[CPUHP_BRINGUP_CPU] = { },
1331 1332 1333
#endif
};

1334 1335 1336
/* Application processor state steps */
static struct cpuhp_step cpuhp_ap_states[] = {
#ifdef CONFIG_SMP
1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348
	/* Final state before CPU kills itself */
	[CPUHP_AP_IDLE_DEAD] = {
		.name			= "idle:dead",
	},
	/*
	 * Last state before CPU enters the idle loop to die. Transient state
	 * for synchronization.
	 */
	[CPUHP_AP_OFFLINE] = {
		.name			= "ap:offline",
		.cant_stop		= true,
	},
1349 1350 1351 1352
	/* First state is scheduler control. Interrupts are disabled */
	[CPUHP_AP_SCHED_STARTING] = {
		.name			= "sched:starting",
		.startup		= sched_cpu_starting,
1353
		.teardown		= sched_cpu_dying,
1354
	},
1355 1356 1357 1358
	[CPUHP_AP_RCUTREE_DYING] = {
		.startup = NULL,
		.teardown = rcutree_dying_cpu,
	},
1359 1360 1361 1362 1363
	/*
	 * Low level startup/teardown notifiers. Run with interrupts
	 * disabled. Will be removed once the notifiers are converted to
	 * states.
	 */
1364 1365 1366 1367 1368
	[CPUHP_AP_NOTIFY_STARTING] = {
		.name			= "notify:starting",
		.startup		= notify_starting,
		.teardown		= notify_dying,
		.skip_onerr		= true,
1369
		.cant_stop		= true,
1370
	},
1371 1372 1373 1374 1375 1376
	/* Entry state on starting. Interrupts enabled from here on. Transient
	 * state for synchronsization */
	[CPUHP_AP_ONLINE] = {
		.name			= "ap:online",
	},
	/* Handle smpboot threads park/unpark */
1377 1378 1379
	[CPUHP_AP_SMPBOOT_THREADS] = {
		.name			= "smpboot:threads",
		.startup		= smpboot_unpark_threads,
1380
		.teardown		= NULL,
1381
	},
1382 1383 1384 1385 1386
	[CPUHP_AP_PERF_ONLINE] = {
		.name = "perf online",
		.startup = perf_event_init_cpu,
		.teardown = perf_event_exit_cpu,
	},
1387 1388 1389 1390 1391
	[CPUHP_AP_WORKQUEUE_ONLINE] = {
		.name = "workqueue online",
		.startup = workqueue_online_cpu,
		.teardown = workqueue_offline_cpu,
	},
1392 1393 1394 1395 1396
	[CPUHP_AP_RCUTREE_ONLINE] = {
		.name = "RCU-tree online",
		.startup = rcutree_online_cpu,
		.teardown = rcutree_offline_cpu,
	},
1397

1398 1399 1400 1401
	/*
	 * Online/down_prepare notifiers. Will be removed once the notifiers
	 * are converted to states.
	 */
1402 1403 1404 1405
	[CPUHP_AP_NOTIFY_ONLINE] = {
		.name			= "notify:online",
		.startup		= notify_online,
		.teardown		= notify_down_prepare,
1406
		.skip_onerr		= true,
1407
	},
1408
#endif
1409 1410 1411 1412
	/*
	 * The dynamically registered state space is here
	 */

1413 1414 1415 1416 1417 1418 1419 1420 1421
#ifdef CONFIG_SMP
	/* Last state is scheduler control setting the cpu active */
	[CPUHP_AP_ACTIVE] = {
		.name			= "sched:active",
		.startup		= sched_cpu_activate,
		.teardown		= sched_cpu_deactivate,
	},
#endif

1422
	/* CPU is fully up and running. */
1423 1424 1425 1426 1427 1428 1429
	[CPUHP_ONLINE] = {
		.name			= "online",
		.startup		= NULL,
		.teardown		= NULL,
	},
};

1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440
/* Sanity check for callbacks */
static int cpuhp_cb_check(enum cpuhp_state state)
{
	if (state <= CPUHP_OFFLINE || state >= CPUHP_ONLINE)
		return -EINVAL;
	return 0;
}

static void cpuhp_store_callbacks(enum cpuhp_state state,
				  const char *name,
				  int (*startup)(unsigned int cpu),
1441 1442
				  int (*teardown)(unsigned int cpu),
				  bool multi_instance)
1443 1444 1445 1446 1447 1448 1449 1450 1451
{
	/* (Un)Install the callbacks for further cpu hotplug operations */
	struct cpuhp_step *sp;

	mutex_lock(&cpuhp_state_mutex);
	sp = cpuhp_get_step(state);
	sp->startup = startup;
	sp->teardown = teardown;
	sp->name = name;
1452 1453
	sp->multi_instance = multi_instance;
	INIT_HLIST_HEAD(&sp->list);
1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465
	mutex_unlock(&cpuhp_state_mutex);
}

static void *cpuhp_get_teardown_cb(enum cpuhp_state state)
{
	return cpuhp_get_step(state)->teardown;
}

/*
 * Call the startup/teardown function for a step either on the AP or
 * on the current CPU.
 */
1466 1467
static int cpuhp_issue_call(int cpu, enum cpuhp_state state, bool bringup,
			    struct hlist_node *node)
1468
{
1469
	struct cpuhp_step *sp = cpuhp_get_step(state);
1470 1471
	int ret;

1472
	if ((bringup && !sp->startup) || (!bringup && !sp->teardown))
1473 1474 1475 1476 1477
		return 0;
	/*
	 * The non AP bound callbacks can fail on bringup. On teardown
	 * e.g. module removal we crash for now.
	 */
1478 1479
#ifdef CONFIG_SMP
	if (cpuhp_is_ap_state(state))
1480
		ret = cpuhp_invoke_ap_callback(cpu, state, bringup, node);
1481
	else
1482
		ret = cpuhp_invoke_callback(cpu, state, bringup, node);
1483
#else
1484
	ret = cpuhp_invoke_callback(cpu, state, bringup, node);
1485
#endif
1486 1487 1488 1489 1490 1491 1492 1493 1494
	BUG_ON(ret && !bringup);
	return ret;
}

/*
 * Called from __cpuhp_setup_state on a recoverable failure.
 *
 * Note: The teardown callbacks for rollback are not allowed to fail!
 */
1495 1496
static void cpuhp_rollback_install(int failedcpu, enum cpuhp_state state,
				   struct hlist_node *node)
1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509
{
	int cpu;

	/* Roll back the already executed steps on the other cpus */
	for_each_present_cpu(cpu) {
		struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);
		int cpustate = st->state;

		if (cpu >= failedcpu)
			break;

		/* Did we invoke the startup call on that cpu ? */
		if (cpustate >= state)
1510
			cpuhp_issue_call(cpu, state, false, node);
1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523
	}
}

/*
 * Returns a free for dynamic slot assignment of the Online state. The states
 * are protected by the cpuhp_slot_states mutex and an empty slot is identified
 * by having no name assigned.
 */
static int cpuhp_reserve_state(enum cpuhp_state state)
{
	enum cpuhp_state i;

	mutex_lock(&cpuhp_state_mutex);
1524 1525
	for (i = CPUHP_AP_ONLINE_DYN; i <= CPUHP_AP_ONLINE_DYN_END; i++) {
		if (cpuhp_ap_states[i].name)
1526 1527
			continue;

1528
		cpuhp_ap_states[i].name = "Reserved";
1529 1530 1531 1532 1533 1534 1535 1536
		mutex_unlock(&cpuhp_state_mutex);
		return i;
	}
	mutex_unlock(&cpuhp_state_mutex);
	WARN(1, "No more dynamic states available for CPU hotplug\n");
	return -ENOSPC;
}

1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582
int __cpuhp_state_add_instance(enum cpuhp_state state, struct hlist_node *node,
			       bool invoke)
{
	struct cpuhp_step *sp;
	int cpu;
	int ret;

	sp = cpuhp_get_step(state);
	if (sp->multi_instance == false)
		return -EINVAL;

	get_online_cpus();

	if (!invoke || !sp->startup_multi)
		goto add_node;

	/*
	 * Try to call the startup callback for each present cpu
	 * depending on the hotplug state of the cpu.
	 */
	for_each_present_cpu(cpu) {
		struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);
		int cpustate = st->state;

		if (cpustate < state)
			continue;

		ret = cpuhp_issue_call(cpu, state, true, node);
		if (ret) {
			if (sp->teardown_multi)
				cpuhp_rollback_install(cpu, state, node);
			goto err;
		}
	}
add_node:
	ret = 0;
	mutex_lock(&cpuhp_state_mutex);
	hlist_add_head(node, &sp->list);
	mutex_unlock(&cpuhp_state_mutex);

err:
	put_online_cpus();
	return ret;
}
EXPORT_SYMBOL_GPL(__cpuhp_state_add_instance);

1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595
/**
 * __cpuhp_setup_state - Setup the callbacks for an hotplug machine state
 * @state:	The state to setup
 * @invoke:	If true, the startup function is invoked for cpus where
 *		cpu state >= @state
 * @startup:	startup callback function
 * @teardown:	teardown callback function
 *
 * Returns 0 if successful, otherwise a proper error code
 */
int __cpuhp_setup_state(enum cpuhp_state state,
			const char *name, bool invoke,
			int (*startup)(unsigned int cpu),
1596 1597
			int (*teardown)(unsigned int cpu),
			bool multi_instance)
1598 1599 1600 1601 1602 1603 1604 1605 1606 1607
{
	int cpu, ret = 0;
	int dyn_state = 0;

	if (cpuhp_cb_check(state) || !name)
		return -EINVAL;

	get_online_cpus();

	/* currently assignments for the ONLINE state are possible */
1608
	if (state == CPUHP_AP_ONLINE_DYN) {
1609 1610 1611 1612 1613 1614 1615
		dyn_state = 1;
		ret = cpuhp_reserve_state(state);
		if (ret < 0)
			goto out;
		state = ret;
	}

1616
	cpuhp_store_callbacks(state, name, startup, teardown, multi_instance);
1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631

	if (!invoke || !startup)
		goto out;

	/*
	 * Try to call the startup callback for each present cpu
	 * depending on the hotplug state of the cpu.
	 */
	for_each_present_cpu(cpu) {
		struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);
		int cpustate = st->state;

		if (cpustate < state)
			continue;

1632
		ret = cpuhp_issue_call(cpu, state, true, NULL);
1633
		if (ret) {
1634
			if (teardown)
1635 1636
				cpuhp_rollback_install(cpu, state, NULL);
			cpuhp_store_callbacks(state, NULL, NULL, NULL, false);
1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647
			goto out;
		}
	}
out:
	put_online_cpus();
	if (!ret && dyn_state)
		return state;
	return ret;
}
EXPORT_SYMBOL(__cpuhp_setup_state);

1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683
int __cpuhp_state_remove_instance(enum cpuhp_state state,
				  struct hlist_node *node, bool invoke)
{
	struct cpuhp_step *sp = cpuhp_get_step(state);
	int cpu;

	BUG_ON(cpuhp_cb_check(state));

	if (!sp->multi_instance)
		return -EINVAL;

	get_online_cpus();
	if (!invoke || !cpuhp_get_teardown_cb(state))
		goto remove;
	/*
	 * Call the teardown callback for each present cpu depending
	 * on the hotplug state of the cpu. This function is not
	 * allowed to fail currently!
	 */
	for_each_present_cpu(cpu) {
		struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);
		int cpustate = st->state;

		if (cpustate >= state)
			cpuhp_issue_call(cpu, state, false, node);
	}

remove:
	mutex_lock(&cpuhp_state_mutex);
	hlist_del(node);
	mutex_unlock(&cpuhp_state_mutex);
	put_online_cpus();

	return 0;
}
EXPORT_SYMBOL_GPL(__cpuhp_state_remove_instance);
1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694
/**
 * __cpuhp_remove_state - Remove the callbacks for an hotplug machine state
 * @state:	The state to remove
 * @invoke:	If true, the teardown function is invoked for cpus where
 *		cpu state >= @state
 *
 * The teardown callback is currently not allowed to fail. Think
 * about module removal!
 */
void __cpuhp_remove_state(enum cpuhp_state state, bool invoke)
{
1695
	struct cpuhp_step *sp = cpuhp_get_step(state);
1696 1697 1698 1699 1700 1701
	int cpu;

	BUG_ON(cpuhp_cb_check(state));

	get_online_cpus();

1702 1703 1704 1705 1706 1707 1708
	if (sp->multi_instance) {
		WARN(!hlist_empty(&sp->list),
		     "Error: Removing state %d which has instances left.\n",
		     state);
		goto remove;
	}

1709
	if (!invoke || !cpuhp_get_teardown_cb(state))
1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721
		goto remove;

	/*
	 * Call the teardown callback for each present cpu depending
	 * on the hotplug state of the cpu. This function is not
	 * allowed to fail currently!
	 */
	for_each_present_cpu(cpu) {
		struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, cpu);
		int cpustate = st->state;

		if (cpustate >= state)
1722
			cpuhp_issue_call(cpu, state, false, NULL);
1723 1724
	}
remove:
1725
	cpuhp_store_callbacks(state, NULL, NULL, NULL, false);
1726 1727 1728 1729
	put_online_cpus();
}
EXPORT_SYMBOL(__cpuhp_remove_state);

1730 1731 1732 1733 1734 1735 1736 1737 1738 1739
#if defined(CONFIG_SYSFS) && defined(CONFIG_HOTPLUG_CPU)
static ssize_t show_cpuhp_state(struct device *dev,
				struct device_attribute *attr, char *buf)
{
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, dev->id);

	return sprintf(buf, "%d\n", st->state);
}
static DEVICE_ATTR(state, 0444, show_cpuhp_state, NULL);

1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779
static ssize_t write_cpuhp_target(struct device *dev,
				  struct device_attribute *attr,
				  const char *buf, size_t count)
{
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, dev->id);
	struct cpuhp_step *sp;
	int target, ret;

	ret = kstrtoint(buf, 10, &target);
	if (ret)
		return ret;

#ifdef CONFIG_CPU_HOTPLUG_STATE_CONTROL
	if (target < CPUHP_OFFLINE || target > CPUHP_ONLINE)
		return -EINVAL;
#else
	if (target != CPUHP_OFFLINE && target != CPUHP_ONLINE)
		return -EINVAL;
#endif

	ret = lock_device_hotplug_sysfs();
	if (ret)
		return ret;

	mutex_lock(&cpuhp_state_mutex);
	sp = cpuhp_get_step(target);
	ret = !sp->name || sp->cant_stop ? -EINVAL : 0;
	mutex_unlock(&cpuhp_state_mutex);
	if (ret)
		return ret;

	if (st->state < target)
		ret = do_cpu_up(dev->id, target);
	else
		ret = do_cpu_down(dev->id, target);

	unlock_device_hotplug();
	return ret ? ret : count;
}

1780 1781 1782 1783 1784 1785 1786
static ssize_t show_cpuhp_target(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	struct cpuhp_cpu_state *st = per_cpu_ptr(&cpuhp_state, dev->id);

	return sprintf(buf, "%d\n", st->target);
}
1787
static DEVICE_ATTR(target, 0644, show_cpuhp_target, write_cpuhp_target);
1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807

static struct attribute *cpuhp_cpu_attrs[] = {
	&dev_attr_state.attr,
	&dev_attr_target.attr,
	NULL
};

static struct attribute_group cpuhp_cpu_attr_group = {
	.attrs = cpuhp_cpu_attrs,
	.name = "hotplug",
	NULL
};

static ssize_t show_cpuhp_states(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	ssize_t cur, res = 0;
	int i;

	mutex_lock(&cpuhp_state_mutex);
1808
	for (i = CPUHP_OFFLINE; i <= CPUHP_ONLINE; i++) {
1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855
		struct cpuhp_step *sp = cpuhp_get_step(i);

		if (sp->name) {
			cur = sprintf(buf, "%3d: %s\n", i, sp->name);
			buf += cur;
			res += cur;
		}
	}
	mutex_unlock(&cpuhp_state_mutex);
	return res;
}
static DEVICE_ATTR(states, 0444, show_cpuhp_states, NULL);

static struct attribute *cpuhp_cpu_root_attrs[] = {
	&dev_attr_states.attr,
	NULL
};

static struct attribute_group cpuhp_cpu_root_attr_group = {
	.attrs = cpuhp_cpu_root_attrs,
	.name = "hotplug",
	NULL
};

static int __init cpuhp_sysfs_init(void)
{
	int cpu, ret;

	ret = sysfs_create_group(&cpu_subsys.dev_root->kobj,
				 &cpuhp_cpu_root_attr_group);
	if (ret)
		return ret;

	for_each_possible_cpu(cpu) {
		struct device *dev = get_cpu_device(cpu);

		if (!dev)
			continue;
		ret = sysfs_create_group(&dev->kobj, &cpuhp_cpu_attr_group);
		if (ret)
			return ret;
	}
	return 0;
}
device_initcall(cpuhp_sysfs_init);
#endif

1856 1857 1858 1859
/*
 * cpu_bit_bitmap[] is a special, "compressed" data structure that
 * represents all NR_CPUS bits binary values of 1<<nr.
 *
R
Rusty Russell 已提交
1860
 * It is used by cpumask_of() to get a constant address to a CPU
1861 1862
 * mask value that has a single bit set only.
 */
1863

1864
/* cpu_bit_bitmap[0] is empty - so we can back into it */
1865
#define MASK_DECLARE_1(x)	[x+1][0] = (1UL << (x))
1866 1867 1868
#define MASK_DECLARE_2(x)	MASK_DECLARE_1(x), MASK_DECLARE_1(x+1)
#define MASK_DECLARE_4(x)	MASK_DECLARE_2(x), MASK_DECLARE_2(x+2)
#define MASK_DECLARE_8(x)	MASK_DECLARE_4(x), MASK_DECLARE_4(x+4)
1869

1870 1871 1872 1873 1874 1875 1876
const unsigned long cpu_bit_bitmap[BITS_PER_LONG+1][BITS_TO_LONGS(NR_CPUS)] = {

	MASK_DECLARE_8(0),	MASK_DECLARE_8(8),
	MASK_DECLARE_8(16),	MASK_DECLARE_8(24),
#if BITS_PER_LONG > 32
	MASK_DECLARE_8(32),	MASK_DECLARE_8(40),
	MASK_DECLARE_8(48),	MASK_DECLARE_8(56),
1877 1878
#endif
};
1879
EXPORT_SYMBOL_GPL(cpu_bit_bitmap);
1880 1881 1882

const DECLARE_BITMAP(cpu_all_bits, NR_CPUS) = CPU_BITS_ALL;
EXPORT_SYMBOL(cpu_all_bits);
1883 1884

#ifdef CONFIG_INIT_ALL_POSSIBLE
1885
struct cpumask __cpu_possible_mask __read_mostly
1886
	= {CPU_BITS_ALL};
1887
#else
1888
struct cpumask __cpu_possible_mask __read_mostly;
1889
#endif
1890
EXPORT_SYMBOL(__cpu_possible_mask);
1891

1892 1893
struct cpumask __cpu_online_mask __read_mostly;
EXPORT_SYMBOL(__cpu_online_mask);
1894

1895 1896
struct cpumask __cpu_present_mask __read_mostly;
EXPORT_SYMBOL(__cpu_present_mask);
1897

1898 1899
struct cpumask __cpu_active_mask __read_mostly;
EXPORT_SYMBOL(__cpu_active_mask);
1900 1901 1902

void init_cpu_present(const struct cpumask *src)
{
1903
	cpumask_copy(&__cpu_present_mask, src);
1904 1905 1906 1907
}

void init_cpu_possible(const struct cpumask *src)
{
1908
	cpumask_copy(&__cpu_possible_mask, src);
1909 1910 1911 1912
}

void init_cpu_online(const struct cpumask *src)
{
1913
	cpumask_copy(&__cpu_online_mask, src);
1914
}
1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936

/*
 * Activate the first processor.
 */
void __init boot_cpu_init(void)
{
	int cpu = smp_processor_id();

	/* Mark the boot cpu "present", "online" etc for SMP and UP case */
	set_cpu_online(cpu, true);
	set_cpu_active(cpu, true);
	set_cpu_present(cpu, true);
	set_cpu_possible(cpu, true);
}

/*
 * Must be called _AFTER_ setting up the per_cpu areas
 */
void __init boot_cpu_state_init(void)
{
	per_cpu_ptr(&cpuhp_state, smp_processor_id())->state = CPUHP_ONLINE;
}