• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  *	linux/kernel/softirq.c
3  *
4  *	Copyright (C) 1992 Linus Torvalds
5  *
6  *	Distribute under GPLv2.
7  *
8  *	Rewritten. Old one was good in 2.2, but in 2.3 it was immoral. --ANK (990903)
9  *
10  *	Remote softirq infrastructure is by Jens Axboe.
11  */
12 
13 #include <linux/export.h>
14 #include <linux/kernel_stat.h>
15 #include <linux/interrupt.h>
16 #include <linux/init.h>
17 #include <linux/mm.h>
18 #include <linux/notifier.h>
19 #include <linux/percpu.h>
20 #include <linux/cpu.h>
21 #include <linux/freezer.h>
22 #include <linux/kthread.h>
23 #include <linux/rcupdate.h>
24 #include <linux/ftrace.h>
25 #include <linux/smp.h>
26 #include <linux/smpboot.h>
27 #include <linux/tick.h>
28 
29 #define CREATE_TRACE_POINTS
30 #include <trace/events/irq.h>
31 
32 #include <asm/irq.h>
33 /*
34    - No shared variables, all the data are CPU local.
35    - If a softirq needs serialization, let it serialize itself
36      by its own spinlocks.
37    - Even if softirq is serialized, only local cpu is marked for
38      execution. Hence, we get something sort of weak cpu binding.
39      Though it is still not clear, will it result in better locality
40      or will not.
41 
42    Examples:
43    - NET RX softirq. It is multithreaded and does not require
44      any global serialization.
45    - NET TX softirq. It kicks software netdevice queues, hence
46      it is logically serialized per device, but this serialization
47      is invisible to common code.
48    - Tasklets: serialized wrt itself.
49  */
50 
51 #ifndef __ARCH_IRQ_STAT
52 irq_cpustat_t irq_stat[NR_CPUS] ____cacheline_aligned;
53 EXPORT_SYMBOL(irq_stat);
54 #endif
55 
56 static struct softirq_action softirq_vec[NR_SOFTIRQS] __cacheline_aligned_in_smp;
57 
58 DEFINE_PER_CPU(struct task_struct *, ksoftirqd);
59 
60 char *softirq_to_name[NR_SOFTIRQS] = {
61 	"HI", "TIMER", "NET_TX", "NET_RX", "BLOCK", "BLOCK_IOPOLL",
62 	"TASKLET", "SCHED", "HRTIMER", "RCU"
63 };
64 
65 /*
66  * we cannot loop indefinitely here to avoid userspace starvation,
67  * but we also don't want to introduce a worst case 1/HZ latency
68  * to the pending events, so lets the scheduler to balance
69  * the softirq load for us.
70  */
wakeup_softirqd(void)71 static void wakeup_softirqd(void)
72 {
73 	/* Interrupts are disabled: no need to stop preemption */
74 	struct task_struct *tsk = __this_cpu_read(ksoftirqd);
75 
76 	if (tsk && tsk->state != TASK_RUNNING)
77 		wake_up_process(tsk);
78 }
79 
80 /*
81  * preempt_count and SOFTIRQ_OFFSET usage:
82  * - preempt_count is changed by SOFTIRQ_OFFSET on entering or leaving
83  *   softirq processing.
84  * - preempt_count is changed by SOFTIRQ_DISABLE_OFFSET (= 2 * SOFTIRQ_OFFSET)
85  *   on local_bh_disable or local_bh_enable.
86  * This lets us distinguish between whether we are currently processing
87  * softirq and whether we just have bh disabled.
88  */
89 
90 /*
91  * This one is for softirq.c-internal use,
92  * where hardirqs are disabled legitimately:
93  */
94 #ifdef CONFIG_TRACE_IRQFLAGS
__local_bh_disable(unsigned long ip,unsigned int cnt)95 static void __local_bh_disable(unsigned long ip, unsigned int cnt)
96 {
97 	unsigned long flags;
98 
99 	WARN_ON_ONCE(in_irq());
100 
101 	raw_local_irq_save(flags);
102 	/*
103 	 * The preempt tracer hooks into add_preempt_count and will break
104 	 * lockdep because it calls back into lockdep after SOFTIRQ_OFFSET
105 	 * is set and before current->softirq_enabled is cleared.
106 	 * We must manually increment preempt_count here and manually
107 	 * call the trace_preempt_off later.
108 	 */
109 	preempt_count() += cnt;
110 	/*
111 	 * Were softirqs turned off above:
112 	 */
113 	if (softirq_count() == cnt)
114 		trace_softirqs_off(ip);
115 	raw_local_irq_restore(flags);
116 
117 	if (preempt_count() == cnt)
118 		trace_preempt_off(CALLER_ADDR0, get_parent_ip(CALLER_ADDR1));
119 }
120 #else /* !CONFIG_TRACE_IRQFLAGS */
__local_bh_disable(unsigned long ip,unsigned int cnt)121 static inline void __local_bh_disable(unsigned long ip, unsigned int cnt)
122 {
123 	add_preempt_count(cnt);
124 	barrier();
125 }
126 #endif /* CONFIG_TRACE_IRQFLAGS */
127 
local_bh_disable(void)128 void local_bh_disable(void)
129 {
130 	__local_bh_disable((unsigned long)__builtin_return_address(0),
131 				SOFTIRQ_DISABLE_OFFSET);
132 }
133 
134 EXPORT_SYMBOL(local_bh_disable);
135 
__local_bh_enable(unsigned int cnt)136 static void __local_bh_enable(unsigned int cnt)
137 {
138 	WARN_ON_ONCE(in_irq());
139 	WARN_ON_ONCE(!irqs_disabled());
140 
141 	if (softirq_count() == cnt)
142 		trace_softirqs_on((unsigned long)__builtin_return_address(0));
143 	sub_preempt_count(cnt);
144 }
145 
146 /*
147  * Special-case - softirqs can safely be enabled in
148  * cond_resched_softirq(), or by __do_softirq(),
149  * without processing still-pending softirqs:
150  */
_local_bh_enable(void)151 void _local_bh_enable(void)
152 {
153 	__local_bh_enable(SOFTIRQ_DISABLE_OFFSET);
154 }
155 
156 EXPORT_SYMBOL(_local_bh_enable);
157 
_local_bh_enable_ip(unsigned long ip)158 static inline void _local_bh_enable_ip(unsigned long ip)
159 {
160 	WARN_ON_ONCE(in_irq() || irqs_disabled());
161 #ifdef CONFIG_TRACE_IRQFLAGS
162 	local_irq_disable();
163 #endif
164 	/*
165 	 * Are softirqs going to be turned on now:
166 	 */
167 	if (softirq_count() == SOFTIRQ_DISABLE_OFFSET)
168 		trace_softirqs_on(ip);
169 	/*
170 	 * Keep preemption disabled until we are done with
171 	 * softirq processing:
172  	 */
173 	sub_preempt_count(SOFTIRQ_DISABLE_OFFSET - 1);
174 
175 	if (unlikely(!in_interrupt() && local_softirq_pending()))
176 		do_softirq();
177 
178 	dec_preempt_count();
179 #ifdef CONFIG_TRACE_IRQFLAGS
180 	local_irq_enable();
181 #endif
182 	preempt_check_resched();
183 }
184 
local_bh_enable(void)185 void local_bh_enable(void)
186 {
187 	_local_bh_enable_ip((unsigned long)__builtin_return_address(0));
188 }
189 EXPORT_SYMBOL(local_bh_enable);
190 
local_bh_enable_ip(unsigned long ip)191 void local_bh_enable_ip(unsigned long ip)
192 {
193 	_local_bh_enable_ip(ip);
194 }
195 EXPORT_SYMBOL(local_bh_enable_ip);
196 
197 /*
198  * We restart softirq processing for at most MAX_SOFTIRQ_RESTART times,
199  * but break the loop if need_resched() is set or after 2 ms.
200  * The MAX_SOFTIRQ_TIME provides a nice upper bound in most cases, but in
201  * certain cases, such as stop_machine(), jiffies may cease to
202  * increment and so we need the MAX_SOFTIRQ_RESTART limit as
203  * well to make sure we eventually return from this method.
204  *
205  * These limits have been established via experimentation.
206  * The two things to balance is latency against fairness -
207  * we want to handle softirqs as soon as possible, but they
208  * should not be able to lock up the box.
209  */
210 #define MAX_SOFTIRQ_TIME  msecs_to_jiffies(2)
211 #define MAX_SOFTIRQ_RESTART 10
212 
__do_softirq(void)213 asmlinkage void __do_softirq(void)
214 {
215 	struct softirq_action *h;
216 	__u32 pending;
217 	unsigned long end = jiffies + MAX_SOFTIRQ_TIME;
218 	int cpu;
219 	unsigned long old_flags = current->flags;
220 	int max_restart = MAX_SOFTIRQ_RESTART;
221 
222 	/*
223 	 * Mask out PF_MEMALLOC s current task context is borrowed for the
224 	 * softirq. A softirq handled such as network RX might set PF_MEMALLOC
225 	 * again if the socket is related to swap
226 	 */
227 	current->flags &= ~PF_MEMALLOC;
228 
229 	pending = local_softirq_pending();
230 	account_irq_enter_time(current);
231 
232 	__local_bh_disable((unsigned long)__builtin_return_address(0),
233 				SOFTIRQ_OFFSET);
234 	lockdep_softirq_enter();
235 
236 	cpu = smp_processor_id();
237 restart:
238 	/* Reset the pending bitmask before enabling irqs */
239 	set_softirq_pending(0);
240 
241 	local_irq_enable();
242 
243 	h = softirq_vec;
244 
245 	do {
246 		if (pending & 1) {
247 			unsigned int vec_nr = h - softirq_vec;
248 			int prev_count = preempt_count();
249 
250 			kstat_incr_softirqs_this_cpu(vec_nr);
251 
252 			trace_softirq_entry(vec_nr);
253 			h->action(h);
254 			trace_softirq_exit(vec_nr);
255 			if (unlikely(prev_count != preempt_count())) {
256 				printk(KERN_ERR "huh, entered softirq %u %s %p"
257 				       "with preempt_count %08x,"
258 				       " exited with %08x?\n", vec_nr,
259 				       softirq_to_name[vec_nr], h->action,
260 				       prev_count, preempt_count());
261 				preempt_count() = prev_count;
262 			}
263 
264 			rcu_bh_qs(cpu);
265 		}
266 		h++;
267 		pending >>= 1;
268 	} while (pending);
269 
270 	local_irq_disable();
271 
272 	pending = local_softirq_pending();
273 	if (pending) {
274 		if (time_before(jiffies, end) && !need_resched() &&
275 		    --max_restart)
276 			goto restart;
277 
278 		wakeup_softirqd();
279 	}
280 
281 	lockdep_softirq_exit();
282 
283 	account_irq_exit_time(current);
284 	__local_bh_enable(SOFTIRQ_OFFSET);
285 	tsk_restore_flags(current, old_flags, PF_MEMALLOC);
286 }
287 
288 #ifndef __ARCH_HAS_DO_SOFTIRQ
289 
do_softirq(void)290 asmlinkage void do_softirq(void)
291 {
292 	__u32 pending;
293 	unsigned long flags;
294 
295 	if (in_interrupt())
296 		return;
297 
298 	local_irq_save(flags);
299 
300 	pending = local_softirq_pending();
301 
302 	if (pending)
303 		__do_softirq();
304 
305 	local_irq_restore(flags);
306 }
307 
308 #endif
309 
310 /*
311  * Enter an interrupt context.
312  */
irq_enter(void)313 void irq_enter(void)
314 {
315 	int cpu = smp_processor_id();
316 
317 	rcu_irq_enter();
318 	if (is_idle_task(current) && !in_interrupt()) {
319 		/*
320 		 * Prevent raise_softirq from needlessly waking up ksoftirqd
321 		 * here, as softirq will be serviced on return from interrupt.
322 		 */
323 		local_bh_disable();
324 		tick_check_idle(cpu);
325 		_local_bh_enable();
326 	}
327 
328 	__irq_enter();
329 }
330 
invoke_softirq(void)331 static inline void invoke_softirq(void)
332 {
333 	if (!force_irqthreads)
334 		__do_softirq();
335 	else
336 		wakeup_softirqd();
337 }
338 
tick_irq_exit(void)339 static inline void tick_irq_exit(void)
340 {
341 #ifdef CONFIG_NO_HZ_COMMON
342 	int cpu = smp_processor_id();
343 
344 	/* Make sure that timer wheel updates are propagated */
345 	if ((idle_cpu(cpu) && !need_resched()) || tick_nohz_full_cpu(cpu)) {
346 		if (!in_interrupt())
347 			tick_nohz_irq_exit();
348 	}
349 #endif
350 }
351 
352 /*
353  * Exit an interrupt context. Process softirqs if needed and possible:
354  */
irq_exit(void)355 void irq_exit(void)
356 {
357 #ifndef __ARCH_IRQ_EXIT_IRQS_DISABLED
358 	local_irq_disable();
359 #else
360 	WARN_ON_ONCE(!irqs_disabled());
361 #endif
362 
363 	account_irq_exit_time(current);
364 	trace_hardirq_exit();
365 	sub_preempt_count(HARDIRQ_OFFSET);
366 	if (!in_interrupt() && local_softirq_pending())
367 		invoke_softirq();
368 
369 	tick_irq_exit();
370 	rcu_irq_exit();
371 }
372 
373 /*
374  * This function must run with irqs disabled!
375  */
raise_softirq_irqoff(unsigned int nr)376 inline void raise_softirq_irqoff(unsigned int nr)
377 {
378 	__raise_softirq_irqoff(nr);
379 
380 	/*
381 	 * If we're in an interrupt or softirq, we're done
382 	 * (this also catches softirq-disabled code). We will
383 	 * actually run the softirq once we return from
384 	 * the irq or softirq.
385 	 *
386 	 * Otherwise we wake up ksoftirqd to make sure we
387 	 * schedule the softirq soon.
388 	 */
389 	if (!in_interrupt())
390 		wakeup_softirqd();
391 }
392 
raise_softirq(unsigned int nr)393 void raise_softirq(unsigned int nr)
394 {
395 	unsigned long flags;
396 
397 	local_irq_save(flags);
398 	raise_softirq_irqoff(nr);
399 	local_irq_restore(flags);
400 }
401 
__raise_softirq_irqoff(unsigned int nr)402 void __raise_softirq_irqoff(unsigned int nr)
403 {
404 	trace_softirq_raise(nr);
405 	or_softirq_pending(1UL << nr);
406 }
407 
open_softirq(int nr,void (* action)(struct softirq_action *))408 void open_softirq(int nr, void (*action)(struct softirq_action *))
409 {
410 	softirq_vec[nr].action = action;
411 }
412 
413 /*
414  * Tasklets
415  */
416 struct tasklet_head
417 {
418 	struct tasklet_struct *head;
419 	struct tasklet_struct **tail;
420 };
421 
422 static DEFINE_PER_CPU(struct tasklet_head, tasklet_vec);
423 static DEFINE_PER_CPU(struct tasklet_head, tasklet_hi_vec);
424 
__tasklet_schedule(struct tasklet_struct * t)425 void __tasklet_schedule(struct tasklet_struct *t)
426 {
427 	unsigned long flags;
428 
429 	local_irq_save(flags);
430 	t->next = NULL;
431 	*__this_cpu_read(tasklet_vec.tail) = t;
432 	__this_cpu_write(tasklet_vec.tail, &(t->next));
433 	raise_softirq_irqoff(TASKLET_SOFTIRQ);
434 	local_irq_restore(flags);
435 }
436 
437 EXPORT_SYMBOL(__tasklet_schedule);
438 
__tasklet_hi_schedule(struct tasklet_struct * t)439 void __tasklet_hi_schedule(struct tasklet_struct *t)
440 {
441 	unsigned long flags;
442 
443 	local_irq_save(flags);
444 	t->next = NULL;
445 	*__this_cpu_read(tasklet_hi_vec.tail) = t;
446 	__this_cpu_write(tasklet_hi_vec.tail,  &(t->next));
447 	raise_softirq_irqoff(HI_SOFTIRQ);
448 	local_irq_restore(flags);
449 }
450 
451 EXPORT_SYMBOL(__tasklet_hi_schedule);
452 
__tasklet_hi_schedule_first(struct tasklet_struct * t)453 void __tasklet_hi_schedule_first(struct tasklet_struct *t)
454 {
455 	BUG_ON(!irqs_disabled());
456 
457 	t->next = __this_cpu_read(tasklet_hi_vec.head);
458 	__this_cpu_write(tasklet_hi_vec.head, t);
459 	__raise_softirq_irqoff(HI_SOFTIRQ);
460 }
461 
462 EXPORT_SYMBOL(__tasklet_hi_schedule_first);
463 
tasklet_action(struct softirq_action * a)464 static void tasklet_action(struct softirq_action *a)
465 {
466 	struct tasklet_struct *list;
467 
468 	local_irq_disable();
469 	list = __this_cpu_read(tasklet_vec.head);
470 	__this_cpu_write(tasklet_vec.head, NULL);
471 	__this_cpu_write(tasklet_vec.tail, &__get_cpu_var(tasklet_vec).head);
472 	local_irq_enable();
473 
474 	while (list) {
475 		struct tasklet_struct *t = list;
476 
477 		list = list->next;
478 
479 		if (tasklet_trylock(t)) {
480 			if (!atomic_read(&t->count)) {
481 				if (!test_and_clear_bit(TASKLET_STATE_SCHED, &t->state))
482 					BUG();
483 				t->func(t->data);
484 				tasklet_unlock(t);
485 				continue;
486 			}
487 			tasklet_unlock(t);
488 		}
489 
490 		local_irq_disable();
491 		t->next = NULL;
492 		*__this_cpu_read(tasklet_vec.tail) = t;
493 		__this_cpu_write(tasklet_vec.tail, &(t->next));
494 		__raise_softirq_irqoff(TASKLET_SOFTIRQ);
495 		local_irq_enable();
496 	}
497 }
498 
tasklet_hi_action(struct softirq_action * a)499 static void tasklet_hi_action(struct softirq_action *a)
500 {
501 	struct tasklet_struct *list;
502 
503 	local_irq_disable();
504 	list = __this_cpu_read(tasklet_hi_vec.head);
505 	__this_cpu_write(tasklet_hi_vec.head, NULL);
506 	__this_cpu_write(tasklet_hi_vec.tail, &__get_cpu_var(tasklet_hi_vec).head);
507 	local_irq_enable();
508 
509 	while (list) {
510 		struct tasklet_struct *t = list;
511 
512 		list = list->next;
513 
514 		if (tasklet_trylock(t)) {
515 			if (!atomic_read(&t->count)) {
516 				if (!test_and_clear_bit(TASKLET_STATE_SCHED, &t->state))
517 					BUG();
518 				t->func(t->data);
519 				tasklet_unlock(t);
520 				continue;
521 			}
522 			tasklet_unlock(t);
523 		}
524 
525 		local_irq_disable();
526 		t->next = NULL;
527 		*__this_cpu_read(tasklet_hi_vec.tail) = t;
528 		__this_cpu_write(tasklet_hi_vec.tail, &(t->next));
529 		__raise_softirq_irqoff(HI_SOFTIRQ);
530 		local_irq_enable();
531 	}
532 }
533 
534 
tasklet_init(struct tasklet_struct * t,void (* func)(unsigned long),unsigned long data)535 void tasklet_init(struct tasklet_struct *t,
536 		  void (*func)(unsigned long), unsigned long data)
537 {
538 	t->next = NULL;
539 	t->state = 0;
540 	atomic_set(&t->count, 0);
541 	t->func = func;
542 	t->data = data;
543 }
544 
545 EXPORT_SYMBOL(tasklet_init);
546 
tasklet_kill(struct tasklet_struct * t)547 void tasklet_kill(struct tasklet_struct *t)
548 {
549 	if (in_interrupt())
550 		printk("Attempt to kill tasklet from interrupt\n");
551 
552 	while (test_and_set_bit(TASKLET_STATE_SCHED, &t->state)) {
553 		do {
554 			yield();
555 		} while (test_bit(TASKLET_STATE_SCHED, &t->state));
556 	}
557 	tasklet_unlock_wait(t);
558 	clear_bit(TASKLET_STATE_SCHED, &t->state);
559 }
560 
561 EXPORT_SYMBOL(tasklet_kill);
562 
563 /*
564  * tasklet_hrtimer
565  */
566 
567 /*
568  * The trampoline is called when the hrtimer expires. It schedules a tasklet
569  * to run __tasklet_hrtimer_trampoline() which in turn will call the intended
570  * hrtimer callback, but from softirq context.
571  */
__hrtimer_tasklet_trampoline(struct hrtimer * timer)572 static enum hrtimer_restart __hrtimer_tasklet_trampoline(struct hrtimer *timer)
573 {
574 	struct tasklet_hrtimer *ttimer =
575 		container_of(timer, struct tasklet_hrtimer, timer);
576 
577 	tasklet_hi_schedule(&ttimer->tasklet);
578 	return HRTIMER_NORESTART;
579 }
580 
581 /*
582  * Helper function which calls the hrtimer callback from
583  * tasklet/softirq context
584  */
__tasklet_hrtimer_trampoline(unsigned long data)585 static void __tasklet_hrtimer_trampoline(unsigned long data)
586 {
587 	struct tasklet_hrtimer *ttimer = (void *)data;
588 	enum hrtimer_restart restart;
589 
590 	restart = ttimer->function(&ttimer->timer);
591 	if (restart != HRTIMER_NORESTART)
592 		hrtimer_restart(&ttimer->timer);
593 }
594 
595 /**
596  * tasklet_hrtimer_init - Init a tasklet/hrtimer combo for softirq callbacks
597  * @ttimer:	 tasklet_hrtimer which is initialized
598  * @function:	 hrtimer callback function which gets called from softirq context
599  * @which_clock: clock id (CLOCK_MONOTONIC/CLOCK_REALTIME)
600  * @mode:	 hrtimer mode (HRTIMER_MODE_ABS/HRTIMER_MODE_REL)
601  */
tasklet_hrtimer_init(struct tasklet_hrtimer * ttimer,enum hrtimer_restart (* function)(struct hrtimer *),clockid_t which_clock,enum hrtimer_mode mode)602 void tasklet_hrtimer_init(struct tasklet_hrtimer *ttimer,
603 			  enum hrtimer_restart (*function)(struct hrtimer *),
604 			  clockid_t which_clock, enum hrtimer_mode mode)
605 {
606 	hrtimer_init(&ttimer->timer, which_clock, mode);
607 	ttimer->timer.function = __hrtimer_tasklet_trampoline;
608 	tasklet_init(&ttimer->tasklet, __tasklet_hrtimer_trampoline,
609 		     (unsigned long)ttimer);
610 	ttimer->function = function;
611 }
612 EXPORT_SYMBOL_GPL(tasklet_hrtimer_init);
613 
614 /*
615  * Remote softirq bits
616  */
617 
618 DEFINE_PER_CPU(struct list_head [NR_SOFTIRQS], softirq_work_list);
619 EXPORT_PER_CPU_SYMBOL(softirq_work_list);
620 
__local_trigger(struct call_single_data * cp,int softirq)621 static void __local_trigger(struct call_single_data *cp, int softirq)
622 {
623 	struct list_head *head = &__get_cpu_var(softirq_work_list[softirq]);
624 
625 	list_add_tail(&cp->list, head);
626 
627 	/* Trigger the softirq only if the list was previously empty.  */
628 	if (head->next == &cp->list)
629 		raise_softirq_irqoff(softirq);
630 }
631 
632 #ifdef CONFIG_USE_GENERIC_SMP_HELPERS
remote_softirq_receive(void * data)633 static void remote_softirq_receive(void *data)
634 {
635 	struct call_single_data *cp = data;
636 	unsigned long flags;
637 	int softirq;
638 
639 	softirq = *(int *)cp->info;
640 	local_irq_save(flags);
641 	__local_trigger(cp, softirq);
642 	local_irq_restore(flags);
643 }
644 
__try_remote_softirq(struct call_single_data * cp,int cpu,int softirq)645 static int __try_remote_softirq(struct call_single_data *cp, int cpu, int softirq)
646 {
647 	if (cpu_online(cpu)) {
648 		cp->func = remote_softirq_receive;
649 		cp->info = &softirq;
650 		cp->flags = 0;
651 
652 		__smp_call_function_single(cpu, cp, 0);
653 		return 0;
654 	}
655 	return 1;
656 }
657 #else /* CONFIG_USE_GENERIC_SMP_HELPERS */
__try_remote_softirq(struct call_single_data * cp,int cpu,int softirq)658 static int __try_remote_softirq(struct call_single_data *cp, int cpu, int softirq)
659 {
660 	return 1;
661 }
662 #endif
663 
664 /**
665  * __send_remote_softirq - try to schedule softirq work on a remote cpu
666  * @cp: private SMP call function data area
667  * @cpu: the remote cpu
668  * @this_cpu: the currently executing cpu
669  * @softirq: the softirq for the work
670  *
671  * Attempt to schedule softirq work on a remote cpu.  If this cannot be
672  * done, the work is instead queued up on the local cpu.
673  *
674  * Interrupts must be disabled.
675  */
__send_remote_softirq(struct call_single_data * cp,int cpu,int this_cpu,int softirq)676 void __send_remote_softirq(struct call_single_data *cp, int cpu, int this_cpu, int softirq)
677 {
678 	if (cpu == this_cpu || __try_remote_softirq(cp, cpu, softirq))
679 		__local_trigger(cp, softirq);
680 }
681 EXPORT_SYMBOL(__send_remote_softirq);
682 
683 /**
684  * send_remote_softirq - try to schedule softirq work on a remote cpu
685  * @cp: private SMP call function data area
686  * @cpu: the remote cpu
687  * @softirq: the softirq for the work
688  *
689  * Like __send_remote_softirq except that disabling interrupts and
690  * computing the current cpu is done for the caller.
691  */
send_remote_softirq(struct call_single_data * cp,int cpu,int softirq)692 void send_remote_softirq(struct call_single_data *cp, int cpu, int softirq)
693 {
694 	unsigned long flags;
695 	int this_cpu;
696 
697 	local_irq_save(flags);
698 	this_cpu = smp_processor_id();
699 	__send_remote_softirq(cp, cpu, this_cpu, softirq);
700 	local_irq_restore(flags);
701 }
702 EXPORT_SYMBOL(send_remote_softirq);
703 
remote_softirq_cpu_notify(struct notifier_block * self,unsigned long action,void * hcpu)704 static int __cpuinit remote_softirq_cpu_notify(struct notifier_block *self,
705 					       unsigned long action, void *hcpu)
706 {
707 	/*
708 	 * If a CPU goes away, splice its entries to the current CPU
709 	 * and trigger a run of the softirq
710 	 */
711 	if (action == CPU_DEAD || action == CPU_DEAD_FROZEN) {
712 		int cpu = (unsigned long) hcpu;
713 		int i;
714 
715 		local_irq_disable();
716 		for (i = 0; i < NR_SOFTIRQS; i++) {
717 			struct list_head *head = &per_cpu(softirq_work_list[i], cpu);
718 			struct list_head *local_head;
719 
720 			if (list_empty(head))
721 				continue;
722 
723 			local_head = &__get_cpu_var(softirq_work_list[i]);
724 			list_splice_init(head, local_head);
725 			raise_softirq_irqoff(i);
726 		}
727 		local_irq_enable();
728 	}
729 
730 	return NOTIFY_OK;
731 }
732 
733 static struct notifier_block __cpuinitdata remote_softirq_cpu_notifier = {
734 	.notifier_call	= remote_softirq_cpu_notify,
735 };
736 
softirq_init(void)737 void __init softirq_init(void)
738 {
739 	int cpu;
740 
741 	for_each_possible_cpu(cpu) {
742 		int i;
743 
744 		per_cpu(tasklet_vec, cpu).tail =
745 			&per_cpu(tasklet_vec, cpu).head;
746 		per_cpu(tasklet_hi_vec, cpu).tail =
747 			&per_cpu(tasklet_hi_vec, cpu).head;
748 		for (i = 0; i < NR_SOFTIRQS; i++)
749 			INIT_LIST_HEAD(&per_cpu(softirq_work_list[i], cpu));
750 	}
751 
752 	register_hotcpu_notifier(&remote_softirq_cpu_notifier);
753 
754 	open_softirq(TASKLET_SOFTIRQ, tasklet_action);
755 	open_softirq(HI_SOFTIRQ, tasklet_hi_action);
756 }
757 
ksoftirqd_should_run(unsigned int cpu)758 static int ksoftirqd_should_run(unsigned int cpu)
759 {
760 	return local_softirq_pending();
761 }
762 
run_ksoftirqd(unsigned int cpu)763 static void run_ksoftirqd(unsigned int cpu)
764 {
765 	local_irq_disable();
766 	if (local_softirq_pending()) {
767 		__do_softirq();
768 		rcu_note_context_switch(cpu);
769 		local_irq_enable();
770 		cond_resched();
771 		return;
772 	}
773 	local_irq_enable();
774 }
775 
776 #ifdef CONFIG_HOTPLUG_CPU
777 /*
778  * tasklet_kill_immediate is called to remove a tasklet which can already be
779  * scheduled for execution on @cpu.
780  *
781  * Unlike tasklet_kill, this function removes the tasklet
782  * _immediately_, even if the tasklet is in TASKLET_STATE_SCHED state.
783  *
784  * When this function is called, @cpu must be in the CPU_DEAD state.
785  */
tasklet_kill_immediate(struct tasklet_struct * t,unsigned int cpu)786 void tasklet_kill_immediate(struct tasklet_struct *t, unsigned int cpu)
787 {
788 	struct tasklet_struct **i;
789 
790 	BUG_ON(cpu_online(cpu));
791 	BUG_ON(test_bit(TASKLET_STATE_RUN, &t->state));
792 
793 	if (!test_bit(TASKLET_STATE_SCHED, &t->state))
794 		return;
795 
796 	/* CPU is dead, so no lock needed. */
797 	for (i = &per_cpu(tasklet_vec, cpu).head; *i; i = &(*i)->next) {
798 		if (*i == t) {
799 			*i = t->next;
800 			/* If this was the tail element, move the tail ptr */
801 			if (*i == NULL)
802 				per_cpu(tasklet_vec, cpu).tail = i;
803 			return;
804 		}
805 	}
806 	BUG();
807 }
808 
takeover_tasklets(unsigned int cpu)809 static void takeover_tasklets(unsigned int cpu)
810 {
811 	/* CPU is dead, so no lock needed. */
812 	local_irq_disable();
813 
814 	/* Find end, append list for that CPU. */
815 	if (&per_cpu(tasklet_vec, cpu).head != per_cpu(tasklet_vec, cpu).tail) {
816 		*__this_cpu_read(tasklet_vec.tail) = per_cpu(tasklet_vec, cpu).head;
817 		this_cpu_write(tasklet_vec.tail, per_cpu(tasklet_vec, cpu).tail);
818 		per_cpu(tasklet_vec, cpu).head = NULL;
819 		per_cpu(tasklet_vec, cpu).tail = &per_cpu(tasklet_vec, cpu).head;
820 	}
821 	raise_softirq_irqoff(TASKLET_SOFTIRQ);
822 
823 	if (&per_cpu(tasklet_hi_vec, cpu).head != per_cpu(tasklet_hi_vec, cpu).tail) {
824 		*__this_cpu_read(tasklet_hi_vec.tail) = per_cpu(tasklet_hi_vec, cpu).head;
825 		__this_cpu_write(tasklet_hi_vec.tail, per_cpu(tasklet_hi_vec, cpu).tail);
826 		per_cpu(tasklet_hi_vec, cpu).head = NULL;
827 		per_cpu(tasklet_hi_vec, cpu).tail = &per_cpu(tasklet_hi_vec, cpu).head;
828 	}
829 	raise_softirq_irqoff(HI_SOFTIRQ);
830 
831 	local_irq_enable();
832 }
833 #endif /* CONFIG_HOTPLUG_CPU */
834 
cpu_callback(struct notifier_block * nfb,unsigned long action,void * hcpu)835 static int __cpuinit cpu_callback(struct notifier_block *nfb,
836 				  unsigned long action,
837 				  void *hcpu)
838 {
839 	switch (action) {
840 #ifdef CONFIG_HOTPLUG_CPU
841 	case CPU_DEAD:
842 	case CPU_DEAD_FROZEN:
843 		takeover_tasklets((unsigned long)hcpu);
844 		break;
845 #endif /* CONFIG_HOTPLUG_CPU */
846 	}
847 	return NOTIFY_OK;
848 }
849 
850 static struct notifier_block __cpuinitdata cpu_nfb = {
851 	.notifier_call = cpu_callback
852 };
853 
854 static struct smp_hotplug_thread softirq_threads = {
855 	.store			= &ksoftirqd,
856 	.thread_should_run	= ksoftirqd_should_run,
857 	.thread_fn		= run_ksoftirqd,
858 	.thread_comm		= "ksoftirqd/%u",
859 };
860 
spawn_ksoftirqd(void)861 static __init int spawn_ksoftirqd(void)
862 {
863 	register_cpu_notifier(&cpu_nfb);
864 
865 	BUG_ON(smpboot_register_percpu_thread(&softirq_threads));
866 
867 	return 0;
868 }
869 early_initcall(spawn_ksoftirqd);
870 
871 /*
872  * [ These __weak aliases are kept in a separate compilation unit, so that
873  *   GCC does not inline them incorrectly. ]
874  */
875 
early_irq_init(void)876 int __init __weak early_irq_init(void)
877 {
878 	return 0;
879 }
880 
881 #ifdef CONFIG_GENERIC_HARDIRQS
arch_probe_nr_irqs(void)882 int __init __weak arch_probe_nr_irqs(void)
883 {
884 	return NR_IRQS_LEGACY;
885 }
886 
arch_early_irq_init(void)887 int __init __weak arch_early_irq_init(void)
888 {
889 	return 0;
890 }
891 #endif
892