kernel/cpu.c

   1 /* CPU control.
   2  * (C) 2001, 2002, 2003, 2004 Rusty Russell
   3  *
   4  * This code is licenced under the GPL.
   5  */
   6 #include <linux/proc_fs.h>
   7 #include <linux/smp.h>
   8 #include <linux/init.h>
   9 #include <linux/notifier.h>
  10 #include <linux/sched.h>
  11 #include <linux/unistd.h>
  12 #include <linux/cpu.h>
  13 #include <linux/oom.h>
  14 #include <linux/rcupdate.h>
  15 #include <linux/export.h>
  16 #include <linux/bug.h>
  17 #include <linux/kthread.h>
  18 #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 <trace/events/power.h>
  26
  27 #include <trace/events/sched.h>
  28
  29 #include "smpboot.h"
  30
  31 #ifdef CONFIG_SMP
  32 /* Serializes the updates to cpu_online_mask, cpu_present_mask */
  33 static DEFINE_MUTEX(cpu_add_remove_lock);
  34
  35 /*
  36  * The following two APIs (cpu_maps_update_begin/done) must be used when
  37  * attempting to serialize the updates to cpu_online_mask & cpu_present_mask.
  38  * The APIs cpu_notifier_register_begin/done() must be used to protect CPU
  39  * hotplug callback (un)registration performed using __register_cpu_notifier()
  40  * or __unregister_cpu_notifier().
  41  */
  42 void cpu_maps_update_begin(void)
  43 {
  44         mutex_lock(&cpu_add_remove_lock);
  45 }
  46 EXPORT_SYMBOL(cpu_notifier_register_begin);
  47
  48 void cpu_maps_update_done(void)
  49 {
  50         mutex_unlock(&cpu_add_remove_lock);
  51 }
  52 EXPORT_SYMBOL(cpu_notifier_register_done);
  53
  54 static RAW_NOTIFIER_HEAD(cpu_chain);
  55
  56 /* If set, cpu_up and cpu_down will return -EBUSY and do nothing.
  57  * Should always be manipulated under cpu_add_remove_lock
  58  */
  59 static int cpu_hotplug_disabled;
  60
  61 #ifdef CONFIG_HOTPLUG_CPU
  62
  63 static struct {
  64         struct task_struct *active_writer;
  65         /* wait queue to wake up the active_writer */
  66         wait_queue_head_t wq;
  67         /* verifies that no writer will get active while readers are active */
  68         struct mutex lock;
  69         /*
  70          * Also blocks the new readers during
  71          * an ongoing cpu hotplug operation.
  72          */
  73         atomic_t refcount;
  74
  75 #ifdef CONFIG_DEBUG_LOCK_ALLOC
  76         struct lockdep_map dep_map;
  77 #endif
  78 } cpu_hotplug = {
  79         .active_writer = NULL,
  80         .wq = __WAIT_QUEUE_HEAD_INITIALIZER(cpu_hotplug.wq),
  81         .lock = __MUTEX_INITIALIZER(cpu_hotplug.lock),
  82 #ifdef CONFIG_DEBUG_LOCK_ALLOC
  83         .dep_map = {.name = "cpu_hotplug.lock" },
  84 #endif
  85 };
  86
  87 /* Lockdep annotations for get/put_online_cpus() and cpu_hotplug_begin/end() */
  88 #define cpuhp_lock_acquire_read() lock_map_acquire_read(&cpu_hotplug.dep_map)
  89 #define cpuhp_lock_acquire_tryread() \
  90                                   lock_map_acquire_tryread(&cpu_hotplug.dep_map)
  91 #define cpuhp_lock_acquire()      lock_map_acquire(&cpu_hotplug.dep_map)
  92 #define cpuhp_lock_release()      lock_map_release(&cpu_hotplug.dep_map)
  93
  94
  95 void get_online_cpus(void)
  96 {
  97         might_sleep();
  98         if (cpu_hotplug.active_writer == current)
  99                 return;
 100         cpuhp_lock_acquire_read();
 101         mutex_lock(&cpu_hotplug.lock);
 102         atomic_inc(&cpu_hotplug.refcount);
 103         mutex_unlock(&cpu_hotplug.lock);
 104 }
 105 EXPORT_SYMBOL_GPL(get_online_cpus);
 106
 107 void put_online_cpus(void)
 108 {
 109         int refcount;
 110
 111         if (cpu_hotplug.active_writer == current)
 112                 return;
 113
 114         refcount = atomic_dec_return(&cpu_hotplug.refcount);
 115         if (WARN_ON(refcount < 0)) /* try to fix things up */
 116                 atomic_inc(&cpu_hotplug.refcount);
 117
 118         if (refcount <= 0 && waitqueue_active(&cpu_hotplug.wq))
 119                 wake_up(&cpu_hotplug.wq);
 120
 121         cpuhp_lock_release();
 122
 123 }
 124 EXPORT_SYMBOL_GPL(put_online_cpus);
 125
 126 /*
 127  * This ensures that the hotplug operation can begin only when the
 128  * refcount goes to zero.
 129  *
 130  * Note that during a cpu-hotplug operation, the new readers, if any,
 131  * will be blocked by the cpu_hotplug.lock
 132  *
 133  * Since cpu_hotplug_begin() is always called after invoking
 134  * cpu_maps_update_begin(), we can be sure that only one writer is active.
 135  *
 136  * Note that theoretically, there is a possibility of a livelock:
 137  * - Refcount goes to zero, last reader wakes up the sleeping
 138  *   writer.
 139  * - Last reader unlocks the cpu_hotplug.lock.
 140  * - A new reader arrives at this moment, bumps up the refcount.
 141  * - The writer acquires the cpu_hotplug.lock finds the refcount
 142  *   non zero and goes to sleep again.
 143  *
 144  * However, this is very difficult to achieve in practice since
 145  * get_online_cpus() not an api which is called all that often.
 146  *
 147  */
 148 void cpu_hotplug_begin(void)
 149 {
 150         DEFINE_WAIT(wait);
 151
 152         cpu_hotplug.active_writer = current;
 153         cpuhp_lock_acquire();
 154
 155         for (;;) {
 156                 mutex_lock(&cpu_hotplug.lock);
 157                 prepare_to_wait(&cpu_hotplug.wq, &wait, TASK_UNINTERRUPTIBLE);
 158                 if (likely(!atomic_read(&cpu_hotplug.refcount)))
 159                                 break;
 160                 mutex_unlock(&cpu_hotplug.lock);
 161                 schedule();
 162         }
 163         finish_wait(&cpu_hotplug.wq, &wait);
 164 }
 165
 166 void cpu_hotplug_done(void)
 167 {
 168         cpu_hotplug.active_writer = NULL;
 169         mutex_unlock(&cpu_hotplug.lock);
 170         cpuhp_lock_release();
 171 }
 172
 173 /*
 174  * Wait for currently running CPU hotplug operations to complete (if any) and
 175  * disable future CPU hotplug (from sysfs). The 'cpu_add_remove_lock' protects
 176  * the 'cpu_hotplug_disabled' flag. The same lock is also acquired by the
 177  * hotplug path before performing hotplug operations. So acquiring that lock
 178  * guarantees mutual exclusion from any currently running hotplug operations.
 179  */
 180 void cpu_hotplug_disable(void)
 181 {
 182         cpu_maps_update_begin();
 183         cpu_hotplug_disabled++;
 184         cpu_maps_update_done();
 185 }
 186 EXPORT_SYMBOL_GPL(cpu_hotplug_disable);
 187
 188 void cpu_hotplug_enable(void)
 189 {
 190         cpu_maps_update_begin();
 191         WARN_ON(--cpu_hotplug_disabled < 0);
 192         cpu_maps_update_done();
 193 }
 194 EXPORT_SYMBOL_GPL(cpu_hotplug_enable);
 195 #endif  /* CONFIG_HOTPLUG_CPU */
 196
 197 /* Need to know about CPUs going up/down? */
 198 int register_cpu_notifier(struct notifier_block *nb)
 199 {
 200         int ret;
 201         cpu_maps_update_begin();
 202         ret = raw_notifier_chain_register(&cpu_chain, nb);
 203         cpu_maps_update_done();
 204         return ret;
 205 }
 206
 207 int __register_cpu_notifier(struct notifier_block *nb)
 208 {
 209         return raw_notifier_chain_register(&cpu_chain, nb);
 210 }
 211
 212 static int __cpu_notify(unsigned long val, void *v, int nr_to_call,
 213                         int *nr_calls)
 214 {
 215         int ret;
 216
 217         ret = __raw_notifier_call_chain(&cpu_chain, val, v, nr_to_call,
 218                                         nr_calls);
 219
 220         return notifier_to_errno(ret);
 221 }
 222
 223 static int cpu_notify(unsigned long val, void *v)
 224 {
 225         return __cpu_notify(val, v, -1, NULL);
 226 }
 227
 228 #ifdef CONFIG_HOTPLUG_CPU
 229
 230 static void cpu_notify_nofail(unsigned long val, void *v)
 231 {
 232         BUG_ON(cpu_notify(val, v));
 233 }
 234 EXPORT_SYMBOL(register_cpu_notifier);
 235 EXPORT_SYMBOL(__register_cpu_notifier);
 236
 237 void unregister_cpu_notifier(struct notifier_block *nb)
 238 {
 239         cpu_maps_update_begin();
 240         raw_notifier_chain_unregister(&cpu_chain, nb);
 241         cpu_maps_update_done();
 242 }
 243 EXPORT_SYMBOL(unregister_cpu_notifier);
 244
 245 void __unregister_cpu_notifier(struct notifier_block *nb)
 246 {
 247         raw_notifier_chain_unregister(&cpu_chain, nb);
 248 }
 249 EXPORT_SYMBOL(__unregister_cpu_notifier);
 250
 251 /**
 252  * clear_tasks_mm_cpumask - Safely clear tasks' mm_cpumask for a CPU
 253  * @cpu: a CPU id
 254  *
 255  * This function walks all processes, finds a valid mm struct for each one and
 256  * then clears a corresponding bit in mm's cpumask.  While this all sounds
 257  * trivial, there are various non-obvious corner cases, which this function
 258  * tries to solve in a safe manner.
 259  *
 260  * Also note that the function uses a somewhat relaxed locking scheme, so it may
 261  * be called only for an already offlined CPU.
 262  */
 263 void clear_tasks_mm_cpumask(int cpu)
 264 {
 265         struct task_struct *p;
 266
 267         /*
 268          * This function is called after the cpu is taken down and marked
 269          * offline, so its not like new tasks will ever get this cpu set in
 270          * their mm mask. -- Peter Zijlstra
 271          * Thus, we may use rcu_read_lock() here, instead of grabbing
 272          * full-fledged tasklist_lock.
 273          */
 274         WARN_ON(cpu_online(cpu));
 275         rcu_read_lock();
 276         for_each_process(p) {
 277                 struct task_struct *t;
 278
 279                 /*
 280                  * Main thread might exit, but other threads may still have
 281                  * a valid mm. Find one.
 282                  */
 283                 t = find_lock_task_mm(p);
 284                 if (!t)
 285                         continue;
 286                 cpumask_clear_cpu(cpu, mm_cpumask(t->mm));
 287                 task_unlock(t);
 288         }
 289         rcu_read_unlock();
 290 }
 291
 292 static inline void check_for_tasks(int dead_cpu)
 293 {
 294         struct task_struct *g, *p;
 295
 296         read_lock(&tasklist_lock);
 297         for_each_process_thread(g, p) {
 298                 if (!p->on_rq)
 299                         continue;
 300                 /*
 301                  * We do the check with unlocked task_rq(p)->lock.
 302                  * Order the reading to do not warn about a task,
 303                  * which was running on this cpu in the past, and
 304                  * it's just been woken on another cpu.
 305                  */
 306                 rmb();
 307                 if (task_cpu(p) != dead_cpu)
 308                         continue;
 309
 310                 pr_warn("Task %s (pid=%d) is on cpu %d (state=%ld, flags=%x)\n",
 311                         p->comm, task_pid_nr(p), dead_cpu, p->state, p->flags);
 312         }
 313         read_unlock(&tasklist_lock);
 314 }
 315
 316 struct take_cpu_down_param {
 317         unsigned long mod;
 318         void *hcpu;
 319 };
 320
 321 /* Take this CPU down. */
 322 static int take_cpu_down(void *_param)
 323 {
 324         struct take_cpu_down_param *param = _param;
 325         int err;
 326
 327         /* Ensure this CPU doesn't handle any more interrupts. */
 328         err = __cpu_disable();
 329         if (err < 0)
 330                 return err;
 331
 332         cpu_notify(CPU_DYING | param->mod, param->hcpu);
 333         /* Give up timekeeping duties */
 334         tick_handover_do_timer();
 335         /* Park the stopper thread */
 336         stop_machine_park((long)param->hcpu);
 337         return 0;
 338 }
 339
 340 /* Requires cpu_add_remove_lock to be held */
 341 static int _cpu_down(unsigned int cpu, int tasks_frozen)
 342 {
 343         int err, nr_calls = 0;
 344         void *hcpu = (void *)(long)cpu;
 345         unsigned long mod = tasks_frozen ? CPU_TASKS_FROZEN : 0;
 346         struct take_cpu_down_param tcd_param = {
 347                 .mod = mod,
 348                 .hcpu = hcpu,
 349         };
 350
 351         if (num_online_cpus() == 1)
 352                 return -EBUSY;
 353
 354         if (!cpu_online(cpu))
 355                 return -EINVAL;
 356
 357         cpu_hotplug_begin();
 358
 359         err = __cpu_notify(CPU_DOWN_PREPARE | mod, hcpu, -1, &nr_calls);
 360         if (err) {
 361                 nr_calls--;
 362                 __cpu_notify(CPU_DOWN_FAILED | mod, hcpu, nr_calls, NULL);
 363                 pr_warn("%s: attempt to take down CPU %u failed\n",
 364                         __func__, cpu);
 365                 goto out_release;
 366         }
 367
 368         /*
 369          * By now we've cleared cpu_active_mask, wait for all preempt-disabled
 370          * and RCU users of this state to go away such that all new such users
 371          * will observe it.
 372          *
 373          * For CONFIG_PREEMPT we have preemptible RCU and its sync_rcu() might
 374          * not imply sync_sched(), so wait for both.
 375          *
 376          * Do sync before park smpboot threads to take care the rcu boost case.
 377          */
 378         if (IS_ENABLED(CONFIG_PREEMPT))
 379                 synchronize_rcu_mult(call_rcu, call_rcu_sched);
 380         else
 381                 synchronize_rcu();
 382
 383         smpboot_park_threads(cpu);
 384
 385         /*
 386          * Prevent irq alloc/free while the dying cpu reorganizes the
 387          * interrupt affinities.
 388          */
 389         irq_lock_sparse();
 390
 391         /*
 392          * So now all preempt/rcu users must observe !cpu_active().
 393          */
 394         err = stop_machine(take_cpu_down, &tcd_param, cpumask_of(cpu));
 395         if (err) {
 396                 /* CPU didn't die: tell everyone.  Can't complain. */
 397                 cpu_notify_nofail(CPU_DOWN_FAILED | mod, hcpu);
 398                 irq_unlock_sparse();
 399                 goto out_release;
 400         }
 401         BUG_ON(cpu_online(cpu));
 402
 403         /*
 404          * The migration_call() CPU_DYING callback will have removed all
 405          * runnable tasks from the cpu, there's only the idle task left now
 406          * that the migration thread is done doing the stop_machine thing.
 407          *
 408          * Wait for the stop thread to go away.
 409          */
 410         while (!per_cpu(cpu_dead_idle, cpu))
 411                 cpu_relax();
 412         smp_mb(); /* Read from cpu_dead_idle before __cpu_die(). */
 413         per_cpu(cpu_dead_idle, cpu) = false;
 414
 415         /* Interrupts are moved away from the dying cpu, reenable alloc/free */
 416         irq_unlock_sparse();
 417
 418         hotplug_cpu__broadcast_tick_pull(cpu);
 419         /* This actually kills the CPU. */
 420         __cpu_die(cpu);
 421
 422         /* CPU is completely dead: tell everyone.  Too late to complain. */
 423         tick_cleanup_dead_cpu(cpu);
 424         cpu_notify_nofail(CPU_DEAD | mod, hcpu);
 425
 426         check_for_tasks(cpu);
 427
 428 out_release:
 429         cpu_hotplug_done();
 430         trace_sched_cpu_hotplug(cpu, err, 0);
 431         if (!err)
 432                 cpu_notify_nofail(CPU_POST_DEAD | mod, hcpu);
 433         return err;
 434 }
 435
 436 int cpu_down(unsigned int cpu)
 437 {
 438         int err;
 439
 440         cpu_maps_update_begin();
 441
 442         if (cpu_hotplug_disabled) {
 443                 err = -EBUSY;
 444                 goto out;
 445         }
 446
 447         err = _cpu_down(cpu, 0);
 448
 449 out:
 450         cpu_maps_update_done();
 451         return err;
 452 }
 453 EXPORT_SYMBOL(cpu_down);
 454 #endif /*CONFIG_HOTPLUG_CPU*/
 455
 456 /*
 457  * Unpark per-CPU smpboot kthreads at CPU-online time.
 458  */
 459 static int smpboot_thread_call(struct notifier_block *nfb,
 460                                unsigned long action, void *hcpu)
 461 {
 462         int cpu = (long)hcpu;
 463
 464         switch (action & ~CPU_TASKS_FROZEN) {
 465
 466         case CPU_DOWN_FAILED:
 467         case CPU_ONLINE:
 468                 smpboot_unpark_threads(cpu);
 469                 break;
 470
 471         default:
 472                 break;
 473         }
 474
 475         return NOTIFY_OK;
 476 }
 477
 478 static struct notifier_block smpboot_thread_notifier = {
 479         .notifier_call = smpboot_thread_call,
 480         .priority = CPU_PRI_SMPBOOT,
 481 };
 482
 483 void smpboot_thread_init(void)
 484 {
 485         register_cpu_notifier(&smpboot_thread_notifier);
 486 }
 487
 488 /* Requires cpu_add_remove_lock to be held */
 489 static int _cpu_up(unsigned int cpu, int tasks_frozen)
 490 {
 491         int ret, nr_calls = 0;
 492         void *hcpu = (void *)(long)cpu;
 493         unsigned long mod = tasks_frozen ? CPU_TASKS_FROZEN : 0;
 494         struct task_struct *idle;
 495
 496         cpu_hotplug_begin();
 497
 498         if (cpu_online(cpu) || !cpu_present(cpu)) {
 499                 ret = -EINVAL;
 500                 goto out;
 501         }
 502
 503         idle = idle_thread_get(cpu);
 504         if (IS_ERR(idle)) {
 505                 ret = PTR_ERR(idle);
 506                 goto out;
 507         }
 508
 509         ret = smpboot_create_threads(cpu);
 510         if (ret)
 511                 goto out;
 512
 513         ret = __cpu_notify(CPU_UP_PREPARE | mod, hcpu, -1, &nr_calls);
 514         if (ret) {
 515                 nr_calls--;
 516                 pr_warn("%s: attempt to bring up CPU %u failed\n",
 517                         __func__, cpu);
 518                 goto out_notify;
 519         }
 520
 521         /* Arch-specific enabling code. */
 522         ret = __cpu_up(cpu, idle);
 523
 524         if (ret != 0)
 525                 goto out_notify;
 526         BUG_ON(!cpu_online(cpu));
 527
 528         /* Now call notifier in preparation. */
 529         cpu_notify(CPU_ONLINE | mod, hcpu);
 530
 531 out_notify:
 532         if (ret != 0)
 533                 __cpu_notify(CPU_UP_CANCELED | mod, hcpu, nr_calls, NULL);
 534 out:
 535         cpu_hotplug_done();
 536         trace_sched_cpu_hotplug(cpu, ret, 1);
 537
 538         return ret;
 539 }
 540
 541 int cpu_up(unsigned int cpu)
 542 {
 543         int err = 0;
 544
 545         if (!cpu_possible(cpu)) {
 546                 pr_err("can't online cpu %d because it is not configured as may-hotadd at boot time\n",
 547                        cpu);
 548 #if defined(CONFIG_IA64)
 549                 pr_err("please check additional_cpus= boot parameter\n");
 550 #endif
 551                 return -EINVAL;
 552         }
 553
 554         err = try_online_node(cpu_to_node(cpu));
 555         if (err)
 556                 return err;
 557
 558         cpu_maps_update_begin();
 559
 560         if (cpu_hotplug_disabled) {
 561                 err = -EBUSY;
 562                 goto out;
 563         }
 564
 565         err = _cpu_up(cpu, 0);
 566
 567 out:
 568         cpu_maps_update_done();
 569         return err;
 570 }
 571 EXPORT_SYMBOL_GPL(cpu_up);
 572
 573 #ifdef CONFIG_PM_SLEEP_SMP
 574 static cpumask_var_t frozen_cpus;
 575
 576 int disable_nonboot_cpus(void)
 577 {
 578         int cpu, first_cpu, error = 0;
 579
 580         cpu_maps_update_begin();
 581         first_cpu = cpumask_first(cpu_online_mask);
 582         /*
 583          * We take down all of the non-boot CPUs in one shot to avoid races
 584          * with the userspace trying to use the CPU hotplug at the same time
 585          */
 586         cpumask_clear(frozen_cpus);
 587
 588         pr_info("Disabling non-boot CPUs ...\n");
 589         for_each_online_cpu(cpu) {
 590                 if (cpu == first_cpu)
 591                         continue;
 592                 trace_suspend_resume(TPS("CPU_OFF"), cpu, true);
 593                 error = _cpu_down(cpu, 1);
 594                 trace_suspend_resume(TPS("CPU_OFF"), cpu, false);
 595                 if (!error)
 596                         cpumask_set_cpu(cpu, frozen_cpus);
 597                 else {
 598                         pr_err("Error taking CPU%d down: %d\n", cpu, error);
 599                         break;
 600                 }
 601         }
 602
 603         if (!error)
 604                 BUG_ON(num_online_cpus() > 1);
 605         else
 606                 pr_err("Non-boot CPUs are not disabled\n");
 607
 608         /*
 609          * Make sure the CPUs won't be enabled by someone else. We need to do
 610          * this even in case of failure as all disable_nonboot_cpus() users are
 611          * supposed to do enable_nonboot_cpus() on the failure path.
 612          */
 613         cpu_hotplug_disabled++;
 614
 615         cpu_maps_update_done();
 616         return error;
 617 }
 618
 619 void __weak arch_enable_nonboot_cpus_begin(void)
 620 {
 621 }
 622
 623 void __weak arch_enable_nonboot_cpus_end(void)
 624 {
 625 }
 626
 627 void enable_nonboot_cpus(void)
 628 {
 629         int cpu, error;
 630
 631         /* Allow everyone to use the CPU hotplug again */
 632         cpu_maps_update_begin();
 633         WARN_ON(--cpu_hotplug_disabled < 0);
 634         if (cpumask_empty(frozen_cpus))
 635                 goto out;
 636
 637         pr_info("Enabling non-boot CPUs ...\n");
 638
 639         arch_enable_nonboot_cpus_begin();
 640
 641         for_each_cpu(cpu, frozen_cpus) {
 642                 trace_suspend_resume(TPS("CPU_ON"), cpu, true);
 643                 error = _cpu_up(cpu, 1);
 644                 trace_suspend_resume(TPS("CPU_ON"), cpu, false);
 645                 if (!error) {
 646                         pr_info("CPU%d is up\n", cpu);
 647                         continue;
 648                 }
 649                 pr_warn("Error taking CPU%d up: %d\n", cpu, error);
 650         }
 651
 652         arch_enable_nonboot_cpus_end();
 653
 654         cpumask_clear(frozen_cpus);
 655 out:
 656         cpu_maps_update_done();
 657 }
 658
 659 static int __init alloc_frozen_cpus(void)
 660 {
 661         if (!alloc_cpumask_var(&frozen_cpus, GFP_KERNEL|__GFP_ZERO))
 662                 return -ENOMEM;
 663         return 0;
 664 }
 665 core_initcall(alloc_frozen_cpus);
 666
 667 /*
 668  * When callbacks for CPU hotplug notifications are being executed, we must
 669  * ensure that the state of the system with respect to the tasks being frozen
 670  * or not, as reported by the notification, remains unchanged *throughout the
 671  * duration* of the execution of the callbacks.
 672  * Hence we need to prevent the freezer from racing with regular CPU hotplug.
 673  *
 674  * This synchronization is implemented by mutually excluding regular CPU
 675  * hotplug and Suspend/Hibernate call paths by hooking onto the Suspend/
 676  * Hibernate notifications.
 677  */
 678 static int
 679 cpu_hotplug_pm_callback(struct notifier_block *nb,
 680                         unsigned long action, void *ptr)
 681 {
 682         switch (action) {
 683
 684         case PM_SUSPEND_PREPARE:
 685         case PM_HIBERNATION_PREPARE:
 686                 cpu_hotplug_disable();
 687                 break;
 688
 689         case PM_POST_SUSPEND:
 690         case PM_POST_HIBERNATION:
 691                 cpu_hotplug_enable();
 692                 break;
 693
 694         default:
 695                 return NOTIFY_DONE;
 696         }
 697
 698         return NOTIFY_OK;
 699 }
 700
 701
 702 static int __init cpu_hotplug_pm_sync_init(void)
 703 {
 704         /*
 705          * cpu_hotplug_pm_callback has higher priority than x86
 706          * bsp_pm_callback which depends on cpu_hotplug_pm_callback
 707          * to disable cpu hotplug to avoid cpu hotplug race.
 708          */
 709         pm_notifier(cpu_hotplug_pm_callback, 0);
 710         return 0;
 711 }
 712 core_initcall(cpu_hotplug_pm_sync_init);
 713
 714 #endif /* CONFIG_PM_SLEEP_SMP */
 715
 716 /**
 717  * notify_cpu_starting(cpu) - call the CPU_STARTING notifiers
 718  * @cpu: cpu that just started
 719  *
 720  * This function calls the cpu_chain notifiers with CPU_STARTING.
 721  * It must be called by the arch code on the new cpu, before the new cpu
 722  * enables interrupts and before the "boot" cpu returns from __cpu_up().
 723  */
 724 void notify_cpu_starting(unsigned int cpu)
 725 {
 726         unsigned long val = CPU_STARTING;
 727
 728 #ifdef CONFIG_PM_SLEEP_SMP
 729         if (frozen_cpus != NULL && cpumask_test_cpu(cpu, frozen_cpus))
 730                 val = CPU_STARTING_FROZEN;
 731 #endif /* CONFIG_PM_SLEEP_SMP */
 732         cpu_notify(val, (void *)(long)cpu);
 733 }
 734
 735 #endif /* CONFIG_SMP */
 736
 737 /*
 738  * cpu_bit_bitmap[] is a special, "compressed" data structure that
 739  * represents all NR_CPUS bits binary values of 1<<nr.
 740  *
 741  * It is used by cpumask_of() to get a constant address to a CPU
 742  * mask value that has a single bit set only.
 743  */
 744
 745 /* cpu_bit_bitmap[0] is empty - so we can back into it */
 746 #define MASK_DECLARE_1(x)       [x+1][0] = (1UL << (x))
 747 #define MASK_DECLARE_2(x)       MASK_DECLARE_1(x), MASK_DECLARE_1(x+1)
 748 #define MASK_DECLARE_4(x)       MASK_DECLARE_2(x), MASK_DECLARE_2(x+2)
 749 #define MASK_DECLARE_8(x)       MASK_DECLARE_4(x), MASK_DECLARE_4(x+4)
 750
 751 const unsigned long cpu_bit_bitmap[BITS_PER_LONG+1][BITS_TO_LONGS(NR_CPUS)] = {
 752
 753         MASK_DECLARE_8(0),      MASK_DECLARE_8(8),
 754         MASK_DECLARE_8(16),     MASK_DECLARE_8(24),
 755 #if BITS_PER_LONG > 32
 756         MASK_DECLARE_8(32),     MASK_DECLARE_8(40),
 757         MASK_DECLARE_8(48),     MASK_DECLARE_8(56),
 758 #endif
 759 };
 760 EXPORT_SYMBOL_GPL(cpu_bit_bitmap);
 761
 762 const DECLARE_BITMAP(cpu_all_bits, NR_CPUS) = CPU_BITS_ALL;
 763 EXPORT_SYMBOL(cpu_all_bits);
 764
 765 #ifdef CONFIG_INIT_ALL_POSSIBLE
 766 static DECLARE_BITMAP(cpu_possible_bits, CONFIG_NR_CPUS) __read_mostly
 767         = CPU_BITS_ALL;
 768 #else
 769 static DECLARE_BITMAP(cpu_possible_bits, CONFIG_NR_CPUS) __read_mostly;
 770 #endif
 771 const struct cpumask *const cpu_possible_mask = to_cpumask(cpu_possible_bits);
 772 EXPORT_SYMBOL(cpu_possible_mask);
 773
 774 static DECLARE_BITMAP(cpu_online_bits, CONFIG_NR_CPUS) __read_mostly;
 775 const struct cpumask *const cpu_online_mask = to_cpumask(cpu_online_bits);
 776 EXPORT_SYMBOL(cpu_online_mask);
 777
 778 static DECLARE_BITMAP(cpu_present_bits, CONFIG_NR_CPUS) __read_mostly;
 779 const struct cpumask *const cpu_present_mask = to_cpumask(cpu_present_bits);
 780 EXPORT_SYMBOL(cpu_present_mask);
 781
 782 static DECLARE_BITMAP(cpu_active_bits, CONFIG_NR_CPUS) __read_mostly;
 783 const struct cpumask *const cpu_active_mask = to_cpumask(cpu_active_bits);
 784 EXPORT_SYMBOL(cpu_active_mask);
 785
 786 void set_cpu_possible(unsigned int cpu, bool possible)
 787 {
 788         if (possible)
 789                 cpumask_set_cpu(cpu, to_cpumask(cpu_possible_bits));
 790         else
 791                 cpumask_clear_cpu(cpu, to_cpumask(cpu_possible_bits));
 792 }
 793
 794 void set_cpu_present(unsigned int cpu, bool present)
 795 {
 796         if (present)
 797                 cpumask_set_cpu(cpu, to_cpumask(cpu_present_bits));
 798         else
 799                 cpumask_clear_cpu(cpu, to_cpumask(cpu_present_bits));
 800 }
 801
 802 void set_cpu_online(unsigned int cpu, bool online)
 803 {
 804         if (online) {
 805                 cpumask_set_cpu(cpu, to_cpumask(cpu_online_bits));
 806                 cpumask_set_cpu(cpu, to_cpumask(cpu_active_bits));
 807         } else {
 808                 cpumask_clear_cpu(cpu, to_cpumask(cpu_online_bits));
 809         }
 810 }
 811
 812 void set_cpu_active(unsigned int cpu, bool active)
 813 {
 814         if (active)
 815                 cpumask_set_cpu(cpu, to_cpumask(cpu_active_bits));
 816         else
 817                 cpumask_clear_cpu(cpu, to_cpumask(cpu_active_bits));
 818 }
 819
 820 void init_cpu_present(const struct cpumask *src)
 821 {
 822         cpumask_copy(to_cpumask(cpu_present_bits), src);
 823 }
 824
 825 void init_cpu_possible(const struct cpumask *src)
 826 {
 827         cpumask_copy(to_cpumask(cpu_possible_bits), src);
 828 }
 829
 830 void init_cpu_online(const struct cpumask *src)
 831 {
 832         cpumask_copy(to_cpumask(cpu_online_bits), src);
 833 }
 834
 835 static ATOMIC_NOTIFIER_HEAD(idle_notifier);
 836
 837 void idle_notifier_register(struct notifier_block *n)
 838 {
 839         atomic_notifier_chain_register(&idle_notifier, n);
 840 }
 841 EXPORT_SYMBOL_GPL(idle_notifier_register);
 842
 843 void idle_notifier_unregister(struct notifier_block *n)
 844 {
 845         atomic_notifier_chain_unregister(&idle_notifier, n);
 846 }
 847 EXPORT_SYMBOL_GPL(idle_notifier_unregister);
 848
 849 void idle_notifier_call_chain(unsigned long val)
 850 {
 851         atomic_notifier_call_chain(&idle_notifier, val, NULL);
 852 }
 853 EXPORT_SYMBOL_GPL(idle_notifier_call_chain);