1
2
3
4
5
6#include <linux/rcupdate.h>
7#include <linux/rculist.h>
8#include <linux/kernel.h>
9#include <linux/export.h>
10#include <linux/percpu.h>
11#include <linux/init.h>
12#include <linux/gfp.h>
13#include <linux/smp.h>
14#include <linux/cpu.h>
15
16#include "smpboot.h"
17
18#ifdef CONFIG_USE_GENERIC_SMP_HELPERS
19static struct {
20 struct list_head queue;
21 raw_spinlock_t lock;
22} call_function __cacheline_aligned_in_smp =
23 {
24 .queue = LIST_HEAD_INIT(call_function.queue),
25 .lock = __RAW_SPIN_LOCK_UNLOCKED(call_function.lock),
26 };
27
28enum {
29 CSD_FLAG_LOCK = 0x01,
30};
31
32struct call_function_data {
33 struct call_single_data csd;
34 atomic_t refs;
35 cpumask_var_t cpumask;
36};
37
38static DEFINE_PER_CPU_SHARED_ALIGNED(struct call_function_data, cfd_data);
39
40struct call_single_queue {
41 struct list_head list;
42 raw_spinlock_t lock;
43};
44
45static DEFINE_PER_CPU_SHARED_ALIGNED(struct call_single_queue, call_single_queue);
46
47static int
48hotplug_cfd(struct notifier_block *nfb, unsigned long action, void *hcpu)
49{
50 long cpu = (long)hcpu;
51 struct call_function_data *cfd = &per_cpu(cfd_data, cpu);
52
53 switch (action) {
54 case CPU_UP_PREPARE:
55 case CPU_UP_PREPARE_FROZEN:
56 if (!zalloc_cpumask_var_node(&cfd->cpumask, GFP_KERNEL,
57 cpu_to_node(cpu)))
58 return notifier_from_errno(-ENOMEM);
59 break;
60
61#ifdef CONFIG_HOTPLUG_CPU
62 case CPU_UP_CANCELED:
63 case CPU_UP_CANCELED_FROZEN:
64
65 case CPU_DEAD:
66 case CPU_DEAD_FROZEN:
67 free_cpumask_var(cfd->cpumask);
68 break;
69#endif
70 };
71
72 return NOTIFY_OK;
73}
74
75static struct notifier_block __cpuinitdata hotplug_cfd_notifier = {
76 .notifier_call = hotplug_cfd,
77};
78
79void __init call_function_init(void)
80{
81 void *cpu = (void *)(long)smp_processor_id();
82 int i;
83
84 for_each_possible_cpu(i) {
85 struct call_single_queue *q = &per_cpu(call_single_queue, i);
86
87 raw_spin_lock_init(&q->lock);
88 INIT_LIST_HEAD(&q->list);
89 }
90
91 hotplug_cfd(&hotplug_cfd_notifier, CPU_UP_PREPARE, cpu);
92 register_cpu_notifier(&hotplug_cfd_notifier);
93}
94
95
96
97
98
99
100
101
102static void csd_lock_wait(struct call_single_data *data)
103{
104 while (data->flags & CSD_FLAG_LOCK)
105 cpu_relax();
106}
107
108static void csd_lock(struct call_single_data *data)
109{
110 csd_lock_wait(data);
111 data->flags = CSD_FLAG_LOCK;
112
113
114
115
116
117
118 smp_mb();
119}
120
121static void csd_unlock(struct call_single_data *data)
122{
123 WARN_ON(!(data->flags & CSD_FLAG_LOCK));
124
125
126
127
128 smp_mb();
129
130 data->flags &= ~CSD_FLAG_LOCK;
131}
132
133
134
135
136
137
138static
139void generic_exec_single(int cpu, struct call_single_data *data, int wait)
140{
141 struct call_single_queue *dst = &per_cpu(call_single_queue, cpu);
142 unsigned long flags;
143 int ipi;
144
145 raw_spin_lock_irqsave(&dst->lock, flags);
146 ipi = list_empty(&dst->list);
147 list_add_tail(&data->list, &dst->list);
148 raw_spin_unlock_irqrestore(&dst->lock, flags);
149
150
151
152
153
154
155
156
157
158
159
160
161 if (ipi)
162 arch_send_call_function_single_ipi(cpu);
163
164 if (wait)
165 csd_lock_wait(data);
166}
167
168
169
170
171
172void generic_smp_call_function_interrupt(void)
173{
174 struct call_function_data *data;
175 int cpu = smp_processor_id();
176
177
178
179
180 WARN_ON_ONCE(!cpu_online(cpu));
181
182
183
184
185
186
187
188 smp_mb();
189
190
191
192
193
194 list_for_each_entry_rcu(data, &call_function.queue, csd.list) {
195 int refs;
196 smp_call_func_t func;
197
198
199
200
201
202
203
204
205
206
207
208 if (!cpumask_test_cpu(cpu, data->cpumask))
209 continue;
210
211 smp_rmb();
212
213 if (atomic_read(&data->refs) == 0)
214 continue;
215
216 func = data->csd.func;
217 func(data->csd.info);
218
219
220
221
222
223
224
225 if (!cpumask_test_and_clear_cpu(cpu, data->cpumask)) {
226 WARN(1, "%pf enabled interrupts and double executed\n", func);
227 continue;
228 }
229
230 refs = atomic_dec_return(&data->refs);
231 WARN_ON(refs < 0);
232
233 if (refs)
234 continue;
235
236 WARN_ON(!cpumask_empty(data->cpumask));
237
238 raw_spin_lock(&call_function.lock);
239 list_del_rcu(&data->csd.list);
240 raw_spin_unlock(&call_function.lock);
241
242 csd_unlock(&data->csd);
243 }
244
245}
246
247
248
249
250
251void generic_smp_call_function_single_interrupt(void)
252{
253 struct call_single_queue *q = &__get_cpu_var(call_single_queue);
254 unsigned int data_flags;
255 LIST_HEAD(list);
256
257
258
259
260 WARN_ON_ONCE(!cpu_online(smp_processor_id()));
261
262 raw_spin_lock(&q->lock);
263 list_replace_init(&q->list, &list);
264 raw_spin_unlock(&q->lock);
265
266 while (!list_empty(&list)) {
267 struct call_single_data *data;
268
269 data = list_entry(list.next, struct call_single_data, list);
270 list_del(&data->list);
271
272
273
274
275
276
277 data_flags = data->flags;
278
279 data->func(data->info);
280
281
282
283
284 if (data_flags & CSD_FLAG_LOCK)
285 csd_unlock(data);
286 }
287}
288
289static DEFINE_PER_CPU_SHARED_ALIGNED(struct call_single_data, csd_data);
290
291
292
293
294
295
296
297
298
299int smp_call_function_single(int cpu, smp_call_func_t func, void *info,
300 int wait)
301{
302 struct call_single_data d = {
303 .flags = 0,
304 };
305 unsigned long flags;
306 int this_cpu;
307 int err = 0;
308
309
310
311
312
313 this_cpu = get_cpu();
314
315
316
317
318
319
320
321 WARN_ON_ONCE(cpu_online(this_cpu) && irqs_disabled()
322 && !oops_in_progress);
323
324 if (cpu == this_cpu) {
325 local_irq_save(flags);
326 func(info);
327 local_irq_restore(flags);
328 } else {
329 if ((unsigned)cpu < nr_cpu_ids && cpu_online(cpu)) {
330 struct call_single_data *data = &d;
331
332 if (!wait)
333 data = &__get_cpu_var(csd_data);
334
335 csd_lock(data);
336
337 data->func = func;
338 data->info = info;
339 generic_exec_single(cpu, data, wait);
340 } else {
341 err = -ENXIO;
342 }
343 }
344
345 put_cpu();
346
347 return err;
348}
349EXPORT_SYMBOL(smp_call_function_single);
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367int smp_call_function_any(const struct cpumask *mask,
368 smp_call_func_t func, void *info, int wait)
369{
370 unsigned int cpu;
371 const struct cpumask *nodemask;
372 int ret;
373
374
375 cpu = get_cpu();
376 if (cpumask_test_cpu(cpu, mask))
377 goto call;
378
379
380 nodemask = cpumask_of_node(cpu_to_node(cpu));
381 for (cpu = cpumask_first_and(nodemask, mask); cpu < nr_cpu_ids;
382 cpu = cpumask_next_and(cpu, nodemask, mask)) {
383 if (cpu_online(cpu))
384 goto call;
385 }
386
387
388 cpu = cpumask_any_and(mask, cpu_online_mask);
389call:
390 ret = smp_call_function_single(cpu, func, info, wait);
391 put_cpu();
392 return ret;
393}
394EXPORT_SYMBOL_GPL(smp_call_function_any);
395
396
397
398
399
400
401
402
403
404
405
406void __smp_call_function_single(int cpu, struct call_single_data *data,
407 int wait)
408{
409 unsigned int this_cpu;
410 unsigned long flags;
411
412 this_cpu = get_cpu();
413
414
415
416
417
418
419 WARN_ON_ONCE(cpu_online(smp_processor_id()) && wait && irqs_disabled()
420 && !oops_in_progress);
421
422 if (cpu == this_cpu) {
423 local_irq_save(flags);
424 data->func(data->info);
425 local_irq_restore(flags);
426 } else {
427 csd_lock(data);
428 generic_exec_single(cpu, data, wait);
429 }
430 put_cpu();
431}
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447void smp_call_function_many(const struct cpumask *mask,
448 smp_call_func_t func, void *info, bool wait)
449{
450 struct call_function_data *data;
451 unsigned long flags;
452 int refs, cpu, next_cpu, this_cpu = smp_processor_id();
453
454
455
456
457
458
459
460 WARN_ON_ONCE(cpu_online(this_cpu) && irqs_disabled()
461 && !oops_in_progress && !early_boot_irqs_disabled);
462
463
464 cpu = cpumask_first_and(mask, cpu_online_mask);
465 if (cpu == this_cpu)
466 cpu = cpumask_next_and(cpu, mask, cpu_online_mask);
467
468
469 if (cpu >= nr_cpu_ids)
470 return;
471
472
473 next_cpu = cpumask_next_and(cpu, mask, cpu_online_mask);
474 if (next_cpu == this_cpu)
475 next_cpu = cpumask_next_and(next_cpu, mask, cpu_online_mask);
476
477
478 if (next_cpu >= nr_cpu_ids) {
479 smp_call_function_single(cpu, func, info, wait);
480 return;
481 }
482
483 data = &__get_cpu_var(cfd_data);
484 csd_lock(&data->csd);
485
486
487 BUG_ON(atomic_read(&data->refs) || !cpumask_empty(data->cpumask));
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510 atomic_set(&data->refs, 0);
511
512 data->csd.func = func;
513 data->csd.info = info;
514
515
516 smp_wmb();
517
518
519 cpumask_and(data->cpumask, mask, cpu_online_mask);
520 cpumask_clear_cpu(this_cpu, data->cpumask);
521 refs = cpumask_weight(data->cpumask);
522
523
524 if (unlikely(!refs)) {
525 csd_unlock(&data->csd);
526 return;
527 }
528
529 raw_spin_lock_irqsave(&call_function.lock, flags);
530
531
532
533
534
535 list_add_rcu(&data->csd.list, &call_function.queue);
536
537
538
539
540
541 atomic_set(&data->refs, refs);
542 raw_spin_unlock_irqrestore(&call_function.lock, flags);
543
544
545
546
547
548
549 smp_mb();
550
551
552 arch_send_call_function_ipi_mask(data->cpumask);
553
554
555 if (wait)
556 csd_lock_wait(&data->csd);
557}
558EXPORT_SYMBOL(smp_call_function_many);
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575int smp_call_function(smp_call_func_t func, void *info, int wait)
576{
577 preempt_disable();
578 smp_call_function_many(cpu_online_mask, func, info, wait);
579 preempt_enable();
580
581 return 0;
582}
583EXPORT_SYMBOL(smp_call_function);
584
585void ipi_call_lock(void)
586{
587 raw_spin_lock(&call_function.lock);
588}
589
590void ipi_call_unlock(void)
591{
592 raw_spin_unlock(&call_function.lock);
593}
594
595void ipi_call_lock_irq(void)
596{
597 raw_spin_lock_irq(&call_function.lock);
598}
599
600void ipi_call_unlock_irq(void)
601{
602 raw_spin_unlock_irq(&call_function.lock);
603}
604#endif
605
606
607unsigned int setup_max_cpus = NR_CPUS;
608EXPORT_SYMBOL(setup_max_cpus);
609
610
611
612
613
614
615
616
617
618
619
620
621
622void __weak arch_disable_smp_support(void) { }
623
624static int __init nosmp(char *str)
625{
626 setup_max_cpus = 0;
627 arch_disable_smp_support();
628
629 return 0;
630}
631
632early_param("nosmp", nosmp);
633
634
635static int __init nrcpus(char *str)
636{
637 int nr_cpus;
638
639 get_option(&str, &nr_cpus);
640 if (nr_cpus > 0 && nr_cpus < nr_cpu_ids)
641 nr_cpu_ids = nr_cpus;
642
643 return 0;
644}
645
646early_param("nr_cpus", nrcpus);
647
648static int __init maxcpus(char *str)
649{
650 get_option(&str, &setup_max_cpus);
651 if (setup_max_cpus == 0)
652 arch_disable_smp_support();
653
654 return 0;
655}
656
657early_param("maxcpus", maxcpus);
658
659
660int nr_cpu_ids __read_mostly = NR_CPUS;
661EXPORT_SYMBOL(nr_cpu_ids);
662
663
664void __init setup_nr_cpu_ids(void)
665{
666 nr_cpu_ids = find_last_bit(cpumask_bits(cpu_possible_mask),NR_CPUS) + 1;
667}
668
669
670void __init smp_init(void)
671{
672 unsigned int cpu;
673
674 idle_threads_init();
675
676
677 for_each_present_cpu(cpu) {
678 if (num_online_cpus() >= setup_max_cpus)
679 break;
680 if (!cpu_online(cpu))
681 cpu_up(cpu);
682 }
683
684
685 printk(KERN_INFO "Brought up %ld CPUs\n", (long)num_online_cpus());
686 smp_cpus_done(setup_max_cpus);
687}
688
689
690
691
692
693
694int on_each_cpu(void (*func) (void *info), void *info, int wait)
695{
696 unsigned long flags;
697 int ret = 0;
698
699 preempt_disable();
700 ret = smp_call_function(func, info, wait);
701 local_irq_save(flags);
702 func(info);
703 local_irq_restore(flags);
704 preempt_enable();
705 return ret;
706}
707EXPORT_SYMBOL(on_each_cpu);
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723void on_each_cpu_mask(const struct cpumask *mask, smp_call_func_t func,
724 void *info, bool wait)
725{
726 int cpu = get_cpu();
727
728 smp_call_function_many(mask, func, info, wait);
729 if (cpumask_test_cpu(cpu, mask)) {
730 local_irq_disable();
731 func(info);
732 local_irq_enable();
733 }
734 put_cpu();
735}
736EXPORT_SYMBOL(on_each_cpu_mask);
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760
761
762
763
764
765void on_each_cpu_cond(bool (*cond_func)(int cpu, void *info),
766 smp_call_func_t func, void *info, bool wait,
767 gfp_t gfp_flags)
768{
769 cpumask_var_t cpus;
770 int cpu, ret;
771
772 might_sleep_if(gfp_flags & __GFP_WAIT);
773
774 if (likely(zalloc_cpumask_var(&cpus, (gfp_flags|__GFP_NOWARN)))) {
775 preempt_disable();
776 for_each_online_cpu(cpu)
777 if (cond_func(cpu, info))
778 cpumask_set_cpu(cpu, cpus);
779 on_each_cpu_mask(cpus, func, info, wait);
780 preempt_enable();
781 free_cpumask_var(cpus);
782 } else {
783
784
785
786
787 preempt_disable();
788 for_each_online_cpu(cpu)
789 if (cond_func(cpu, info)) {
790 ret = smp_call_function_single(cpu, func,
791 info, wait);
792 WARN_ON_ONCE(!ret);
793 }
794 preempt_enable();
795 }
796}
797EXPORT_SYMBOL(on_each_cpu_cond);
798
799static void do_nothing(void *unused)
800{
801}
802
803
804
805
806
807
808
809
810
811
812
813
814void kick_all_cpus_sync(void)
815{
816
817 smp_mb();
818 smp_call_function(do_nothing, NULL, 1);
819}
820EXPORT_SYMBOL_GPL(kick_all_cpus_sync);
821