xref: /openbmc/linux/kernel/softirq.c (revision f39650de)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  *	linux/kernel/softirq.c
4  *
5  *	Copyright (C) 1992 Linus Torvalds
6  *
7  *	Rewritten. Old one was good in 2.2, but in 2.3 it was immoral. --ANK (990903)
8  */
9 
10 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
11 
12 #include <linux/export.h>
13 #include <linux/kernel_stat.h>
14 #include <linux/interrupt.h>
15 #include <linux/init.h>
16 #include <linux/local_lock.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 #include <linux/irq.h>
29 #include <linux/wait_bit.h>
30 
31 #include <asm/softirq_stack.h>
32 
33 #define CREATE_TRACE_POINTS
34 #include <trace/events/irq.h>
35 
36 /*
37    - No shared variables, all the data are CPU local.
38    - If a softirq needs serialization, let it serialize itself
39      by its own spinlocks.
40    - Even if softirq is serialized, only local cpu is marked for
41      execution. Hence, we get something sort of weak cpu binding.
42      Though it is still not clear, will it result in better locality
43      or will not.
44 
45    Examples:
46    - NET RX softirq. It is multithreaded and does not require
47      any global serialization.
48    - NET TX softirq. It kicks software netdevice queues, hence
49      it is logically serialized per device, but this serialization
50      is invisible to common code.
51    - Tasklets: serialized wrt itself.
52  */
53 
54 #ifndef __ARCH_IRQ_STAT
55 DEFINE_PER_CPU_ALIGNED(irq_cpustat_t, irq_stat);
56 EXPORT_PER_CPU_SYMBOL(irq_stat);
57 #endif
58 
59 static struct softirq_action softirq_vec[NR_SOFTIRQS] __cacheline_aligned_in_smp;
60 
61 DEFINE_PER_CPU(struct task_struct *, ksoftirqd);
62 
63 const char * const softirq_to_name[NR_SOFTIRQS] = {
64 	"HI", "TIMER", "NET_TX", "NET_RX", "BLOCK", "IRQ_POLL",
65 	"TASKLET", "SCHED", "HRTIMER", "RCU"
66 };
67 
68 /*
69  * we cannot loop indefinitely here to avoid userspace starvation,
70  * but we also don't want to introduce a worst case 1/HZ latency
71  * to the pending events, so lets the scheduler to balance
72  * the softirq load for us.
73  */
74 static void wakeup_softirqd(void)
75 {
76 	/* Interrupts are disabled: no need to stop preemption */
77 	struct task_struct *tsk = __this_cpu_read(ksoftirqd);
78 
79 	if (tsk && tsk->state != TASK_RUNNING)
80 		wake_up_process(tsk);
81 }
82 
83 /*
84  * If ksoftirqd is scheduled, we do not want to process pending softirqs
85  * right now. Let ksoftirqd handle this at its own rate, to get fairness,
86  * unless we're doing some of the synchronous softirqs.
87  */
88 #define SOFTIRQ_NOW_MASK ((1 << HI_SOFTIRQ) | (1 << TASKLET_SOFTIRQ))
89 static bool ksoftirqd_running(unsigned long pending)
90 {
91 	struct task_struct *tsk = __this_cpu_read(ksoftirqd);
92 
93 	if (pending & SOFTIRQ_NOW_MASK)
94 		return false;
95 	return tsk && (tsk->state == TASK_RUNNING) &&
96 		!__kthread_should_park(tsk);
97 }
98 
99 #ifdef CONFIG_TRACE_IRQFLAGS
100 DEFINE_PER_CPU(int, hardirqs_enabled);
101 DEFINE_PER_CPU(int, hardirq_context);
102 EXPORT_PER_CPU_SYMBOL_GPL(hardirqs_enabled);
103 EXPORT_PER_CPU_SYMBOL_GPL(hardirq_context);
104 #endif
105 
106 /*
107  * SOFTIRQ_OFFSET usage:
108  *
109  * On !RT kernels 'count' is the preempt counter, on RT kernels this applies
110  * to a per CPU counter and to task::softirqs_disabled_cnt.
111  *
112  * - count is changed by SOFTIRQ_OFFSET on entering or leaving softirq
113  *   processing.
114  *
115  * - count is changed by SOFTIRQ_DISABLE_OFFSET (= 2 * SOFTIRQ_OFFSET)
116  *   on local_bh_disable or local_bh_enable.
117  *
118  * This lets us distinguish between whether we are currently processing
119  * softirq and whether we just have bh disabled.
120  */
121 #ifdef CONFIG_PREEMPT_RT
122 
123 /*
124  * RT accounts for BH disabled sections in task::softirqs_disabled_cnt and
125  * also in per CPU softirq_ctrl::cnt. This is necessary to allow tasks in a
126  * softirq disabled section to be preempted.
127  *
128  * The per task counter is used for softirq_count(), in_softirq() and
129  * in_serving_softirqs() because these counts are only valid when the task
130  * holding softirq_ctrl::lock is running.
131  *
132  * The per CPU counter prevents pointless wakeups of ksoftirqd in case that
133  * the task which is in a softirq disabled section is preempted or blocks.
134  */
135 struct softirq_ctrl {
136 	local_lock_t	lock;
137 	int		cnt;
138 };
139 
140 static DEFINE_PER_CPU(struct softirq_ctrl, softirq_ctrl) = {
141 	.lock	= INIT_LOCAL_LOCK(softirq_ctrl.lock),
142 };
143 
144 /**
145  * local_bh_blocked() - Check for idle whether BH processing is blocked
146  *
147  * Returns false if the per CPU softirq::cnt is 0 otherwise true.
148  *
149  * This is invoked from the idle task to guard against false positive
150  * softirq pending warnings, which would happen when the task which holds
151  * softirq_ctrl::lock was the only running task on the CPU and blocks on
152  * some other lock.
153  */
154 bool local_bh_blocked(void)
155 {
156 	return __this_cpu_read(softirq_ctrl.cnt) != 0;
157 }
158 
159 void __local_bh_disable_ip(unsigned long ip, unsigned int cnt)
160 {
161 	unsigned long flags;
162 	int newcnt;
163 
164 	WARN_ON_ONCE(in_hardirq());
165 
166 	/* First entry of a task into a BH disabled section? */
167 	if (!current->softirq_disable_cnt) {
168 		if (preemptible()) {
169 			local_lock(&softirq_ctrl.lock);
170 			/* Required to meet the RCU bottomhalf requirements. */
171 			rcu_read_lock();
172 		} else {
173 			DEBUG_LOCKS_WARN_ON(this_cpu_read(softirq_ctrl.cnt));
174 		}
175 	}
176 
177 	/*
178 	 * Track the per CPU softirq disabled state. On RT this is per CPU
179 	 * state to allow preemption of bottom half disabled sections.
180 	 */
181 	newcnt = __this_cpu_add_return(softirq_ctrl.cnt, cnt);
182 	/*
183 	 * Reflect the result in the task state to prevent recursion on the
184 	 * local lock and to make softirq_count() & al work.
185 	 */
186 	current->softirq_disable_cnt = newcnt;
187 
188 	if (IS_ENABLED(CONFIG_TRACE_IRQFLAGS) && newcnt == cnt) {
189 		raw_local_irq_save(flags);
190 		lockdep_softirqs_off(ip);
191 		raw_local_irq_restore(flags);
192 	}
193 }
194 EXPORT_SYMBOL(__local_bh_disable_ip);
195 
196 static void __local_bh_enable(unsigned int cnt, bool unlock)
197 {
198 	unsigned long flags;
199 	int newcnt;
200 
201 	DEBUG_LOCKS_WARN_ON(current->softirq_disable_cnt !=
202 			    this_cpu_read(softirq_ctrl.cnt));
203 
204 	if (IS_ENABLED(CONFIG_TRACE_IRQFLAGS) && softirq_count() == cnt) {
205 		raw_local_irq_save(flags);
206 		lockdep_softirqs_on(_RET_IP_);
207 		raw_local_irq_restore(flags);
208 	}
209 
210 	newcnt = __this_cpu_sub_return(softirq_ctrl.cnt, cnt);
211 	current->softirq_disable_cnt = newcnt;
212 
213 	if (!newcnt && unlock) {
214 		rcu_read_unlock();
215 		local_unlock(&softirq_ctrl.lock);
216 	}
217 }
218 
219 void __local_bh_enable_ip(unsigned long ip, unsigned int cnt)
220 {
221 	bool preempt_on = preemptible();
222 	unsigned long flags;
223 	u32 pending;
224 	int curcnt;
225 
226 	WARN_ON_ONCE(in_irq());
227 	lockdep_assert_irqs_enabled();
228 
229 	local_irq_save(flags);
230 	curcnt = __this_cpu_read(softirq_ctrl.cnt);
231 
232 	/*
233 	 * If this is not reenabling soft interrupts, no point in trying to
234 	 * run pending ones.
235 	 */
236 	if (curcnt != cnt)
237 		goto out;
238 
239 	pending = local_softirq_pending();
240 	if (!pending || ksoftirqd_running(pending))
241 		goto out;
242 
243 	/*
244 	 * If this was called from non preemptible context, wake up the
245 	 * softirq daemon.
246 	 */
247 	if (!preempt_on) {
248 		wakeup_softirqd();
249 		goto out;
250 	}
251 
252 	/*
253 	 * Adjust softirq count to SOFTIRQ_OFFSET which makes
254 	 * in_serving_softirq() become true.
255 	 */
256 	cnt = SOFTIRQ_OFFSET;
257 	__local_bh_enable(cnt, false);
258 	__do_softirq();
259 
260 out:
261 	__local_bh_enable(cnt, preempt_on);
262 	local_irq_restore(flags);
263 }
264 EXPORT_SYMBOL(__local_bh_enable_ip);
265 
266 /*
267  * Invoked from ksoftirqd_run() outside of the interrupt disabled section
268  * to acquire the per CPU local lock for reentrancy protection.
269  */
270 static inline void ksoftirqd_run_begin(void)
271 {
272 	__local_bh_disable_ip(_RET_IP_, SOFTIRQ_OFFSET);
273 	local_irq_disable();
274 }
275 
276 /* Counterpart to ksoftirqd_run_begin() */
277 static inline void ksoftirqd_run_end(void)
278 {
279 	__local_bh_enable(SOFTIRQ_OFFSET, true);
280 	WARN_ON_ONCE(in_interrupt());
281 	local_irq_enable();
282 }
283 
284 static inline void softirq_handle_begin(void) { }
285 static inline void softirq_handle_end(void) { }
286 
287 static inline bool should_wake_ksoftirqd(void)
288 {
289 	return !this_cpu_read(softirq_ctrl.cnt);
290 }
291 
292 static inline void invoke_softirq(void)
293 {
294 	if (should_wake_ksoftirqd())
295 		wakeup_softirqd();
296 }
297 
298 #else /* CONFIG_PREEMPT_RT */
299 
300 /*
301  * This one is for softirq.c-internal use, where hardirqs are disabled
302  * legitimately:
303  */
304 #ifdef CONFIG_TRACE_IRQFLAGS
305 void __local_bh_disable_ip(unsigned long ip, unsigned int cnt)
306 {
307 	unsigned long flags;
308 
309 	WARN_ON_ONCE(in_irq());
310 
311 	raw_local_irq_save(flags);
312 	/*
313 	 * The preempt tracer hooks into preempt_count_add and will break
314 	 * lockdep because it calls back into lockdep after SOFTIRQ_OFFSET
315 	 * is set and before current->softirq_enabled is cleared.
316 	 * We must manually increment preempt_count here and manually
317 	 * call the trace_preempt_off later.
318 	 */
319 	__preempt_count_add(cnt);
320 	/*
321 	 * Were softirqs turned off above:
322 	 */
323 	if (softirq_count() == (cnt & SOFTIRQ_MASK))
324 		lockdep_softirqs_off(ip);
325 	raw_local_irq_restore(flags);
326 
327 	if (preempt_count() == cnt) {
328 #ifdef CONFIG_DEBUG_PREEMPT
329 		current->preempt_disable_ip = get_lock_parent_ip();
330 #endif
331 		trace_preempt_off(CALLER_ADDR0, get_lock_parent_ip());
332 	}
333 }
334 EXPORT_SYMBOL(__local_bh_disable_ip);
335 #endif /* CONFIG_TRACE_IRQFLAGS */
336 
337 static void __local_bh_enable(unsigned int cnt)
338 {
339 	lockdep_assert_irqs_disabled();
340 
341 	if (preempt_count() == cnt)
342 		trace_preempt_on(CALLER_ADDR0, get_lock_parent_ip());
343 
344 	if (softirq_count() == (cnt & SOFTIRQ_MASK))
345 		lockdep_softirqs_on(_RET_IP_);
346 
347 	__preempt_count_sub(cnt);
348 }
349 
350 /*
351  * Special-case - softirqs can safely be enabled by __do_softirq(),
352  * without processing still-pending softirqs:
353  */
354 void _local_bh_enable(void)
355 {
356 	WARN_ON_ONCE(in_irq());
357 	__local_bh_enable(SOFTIRQ_DISABLE_OFFSET);
358 }
359 EXPORT_SYMBOL(_local_bh_enable);
360 
361 void __local_bh_enable_ip(unsigned long ip, unsigned int cnt)
362 {
363 	WARN_ON_ONCE(in_irq());
364 	lockdep_assert_irqs_enabled();
365 #ifdef CONFIG_TRACE_IRQFLAGS
366 	local_irq_disable();
367 #endif
368 	/*
369 	 * Are softirqs going to be turned on now:
370 	 */
371 	if (softirq_count() == SOFTIRQ_DISABLE_OFFSET)
372 		lockdep_softirqs_on(ip);
373 	/*
374 	 * Keep preemption disabled until we are done with
375 	 * softirq processing:
376 	 */
377 	__preempt_count_sub(cnt - 1);
378 
379 	if (unlikely(!in_interrupt() && local_softirq_pending())) {
380 		/*
381 		 * Run softirq if any pending. And do it in its own stack
382 		 * as we may be calling this deep in a task call stack already.
383 		 */
384 		do_softirq();
385 	}
386 
387 	preempt_count_dec();
388 #ifdef CONFIG_TRACE_IRQFLAGS
389 	local_irq_enable();
390 #endif
391 	preempt_check_resched();
392 }
393 EXPORT_SYMBOL(__local_bh_enable_ip);
394 
395 static inline void softirq_handle_begin(void)
396 {
397 	__local_bh_disable_ip(_RET_IP_, SOFTIRQ_OFFSET);
398 }
399 
400 static inline void softirq_handle_end(void)
401 {
402 	__local_bh_enable(SOFTIRQ_OFFSET);
403 	WARN_ON_ONCE(in_interrupt());
404 }
405 
406 static inline void ksoftirqd_run_begin(void)
407 {
408 	local_irq_disable();
409 }
410 
411 static inline void ksoftirqd_run_end(void)
412 {
413 	local_irq_enable();
414 }
415 
416 static inline bool should_wake_ksoftirqd(void)
417 {
418 	return true;
419 }
420 
421 static inline void invoke_softirq(void)
422 {
423 	if (ksoftirqd_running(local_softirq_pending()))
424 		return;
425 
426 	if (!force_irqthreads || !__this_cpu_read(ksoftirqd)) {
427 #ifdef CONFIG_HAVE_IRQ_EXIT_ON_IRQ_STACK
428 		/*
429 		 * We can safely execute softirq on the current stack if
430 		 * it is the irq stack, because it should be near empty
431 		 * at this stage.
432 		 */
433 		__do_softirq();
434 #else
435 		/*
436 		 * Otherwise, irq_exit() is called on the task stack that can
437 		 * be potentially deep already. So call softirq in its own stack
438 		 * to prevent from any overrun.
439 		 */
440 		do_softirq_own_stack();
441 #endif
442 	} else {
443 		wakeup_softirqd();
444 	}
445 }
446 
447 asmlinkage __visible void do_softirq(void)
448 {
449 	__u32 pending;
450 	unsigned long flags;
451 
452 	if (in_interrupt())
453 		return;
454 
455 	local_irq_save(flags);
456 
457 	pending = local_softirq_pending();
458 
459 	if (pending && !ksoftirqd_running(pending))
460 		do_softirq_own_stack();
461 
462 	local_irq_restore(flags);
463 }
464 
465 #endif /* !CONFIG_PREEMPT_RT */
466 
467 /*
468  * We restart softirq processing for at most MAX_SOFTIRQ_RESTART times,
469  * but break the loop if need_resched() is set or after 2 ms.
470  * The MAX_SOFTIRQ_TIME provides a nice upper bound in most cases, but in
471  * certain cases, such as stop_machine(), jiffies may cease to
472  * increment and so we need the MAX_SOFTIRQ_RESTART limit as
473  * well to make sure we eventually return from this method.
474  *
475  * These limits have been established via experimentation.
476  * The two things to balance is latency against fairness -
477  * we want to handle softirqs as soon as possible, but they
478  * should not be able to lock up the box.
479  */
480 #define MAX_SOFTIRQ_TIME  msecs_to_jiffies(2)
481 #define MAX_SOFTIRQ_RESTART 10
482 
483 #ifdef CONFIG_TRACE_IRQFLAGS
484 /*
485  * When we run softirqs from irq_exit() and thus on the hardirq stack we need
486  * to keep the lockdep irq context tracking as tight as possible in order to
487  * not miss-qualify lock contexts and miss possible deadlocks.
488  */
489 
490 static inline bool lockdep_softirq_start(void)
491 {
492 	bool in_hardirq = false;
493 
494 	if (lockdep_hardirq_context()) {
495 		in_hardirq = true;
496 		lockdep_hardirq_exit();
497 	}
498 
499 	lockdep_softirq_enter();
500 
501 	return in_hardirq;
502 }
503 
504 static inline void lockdep_softirq_end(bool in_hardirq)
505 {
506 	lockdep_softirq_exit();
507 
508 	if (in_hardirq)
509 		lockdep_hardirq_enter();
510 }
511 #else
512 static inline bool lockdep_softirq_start(void) { return false; }
513 static inline void lockdep_softirq_end(bool in_hardirq) { }
514 #endif
515 
516 asmlinkage __visible void __softirq_entry __do_softirq(void)
517 {
518 	unsigned long end = jiffies + MAX_SOFTIRQ_TIME;
519 	unsigned long old_flags = current->flags;
520 	int max_restart = MAX_SOFTIRQ_RESTART;
521 	struct softirq_action *h;
522 	bool in_hardirq;
523 	__u32 pending;
524 	int softirq_bit;
525 
526 	/*
527 	 * Mask out PF_MEMALLOC as the current task context is borrowed for the
528 	 * softirq. A softirq handled, such as network RX, might set PF_MEMALLOC
529 	 * again if the socket is related to swapping.
530 	 */
531 	current->flags &= ~PF_MEMALLOC;
532 
533 	pending = local_softirq_pending();
534 
535 	softirq_handle_begin();
536 	in_hardirq = lockdep_softirq_start();
537 	account_softirq_enter(current);
538 
539 restart:
540 	/* Reset the pending bitmask before enabling irqs */
541 	set_softirq_pending(0);
542 
543 	local_irq_enable();
544 
545 	h = softirq_vec;
546 
547 	while ((softirq_bit = ffs(pending))) {
548 		unsigned int vec_nr;
549 		int prev_count;
550 
551 		h += softirq_bit - 1;
552 
553 		vec_nr = h - softirq_vec;
554 		prev_count = preempt_count();
555 
556 		kstat_incr_softirqs_this_cpu(vec_nr);
557 
558 		trace_softirq_entry(vec_nr);
559 		h->action(h);
560 		trace_softirq_exit(vec_nr);
561 		if (unlikely(prev_count != preempt_count())) {
562 			pr_err("huh, entered softirq %u %s %p with preempt_count %08x, exited with %08x?\n",
563 			       vec_nr, softirq_to_name[vec_nr], h->action,
564 			       prev_count, preempt_count());
565 			preempt_count_set(prev_count);
566 		}
567 		h++;
568 		pending >>= softirq_bit;
569 	}
570 
571 	if (!IS_ENABLED(CONFIG_PREEMPT_RT) &&
572 	    __this_cpu_read(ksoftirqd) == current)
573 		rcu_softirq_qs();
574 
575 	local_irq_disable();
576 
577 	pending = local_softirq_pending();
578 	if (pending) {
579 		if (time_before(jiffies, end) && !need_resched() &&
580 		    --max_restart)
581 			goto restart;
582 
583 		wakeup_softirqd();
584 	}
585 
586 	account_softirq_exit(current);
587 	lockdep_softirq_end(in_hardirq);
588 	softirq_handle_end();
589 	current_restore_flags(old_flags, PF_MEMALLOC);
590 }
591 
592 /**
593  * irq_enter_rcu - Enter an interrupt context with RCU watching
594  */
595 void irq_enter_rcu(void)
596 {
597 	__irq_enter_raw();
598 
599 	if (is_idle_task(current) && (irq_count() == HARDIRQ_OFFSET))
600 		tick_irq_enter();
601 
602 	account_hardirq_enter(current);
603 }
604 
605 /**
606  * irq_enter - Enter an interrupt context including RCU update
607  */
608 void irq_enter(void)
609 {
610 	rcu_irq_enter();
611 	irq_enter_rcu();
612 }
613 
614 static inline void tick_irq_exit(void)
615 {
616 #ifdef CONFIG_NO_HZ_COMMON
617 	int cpu = smp_processor_id();
618 
619 	/* Make sure that timer wheel updates are propagated */
620 	if ((idle_cpu(cpu) && !need_resched()) || tick_nohz_full_cpu(cpu)) {
621 		if (!in_irq())
622 			tick_nohz_irq_exit();
623 	}
624 #endif
625 }
626 
627 static inline void __irq_exit_rcu(void)
628 {
629 #ifndef __ARCH_IRQ_EXIT_IRQS_DISABLED
630 	local_irq_disable();
631 #else
632 	lockdep_assert_irqs_disabled();
633 #endif
634 	account_hardirq_exit(current);
635 	preempt_count_sub(HARDIRQ_OFFSET);
636 	if (!in_interrupt() && local_softirq_pending())
637 		invoke_softirq();
638 
639 	tick_irq_exit();
640 }
641 
642 /**
643  * irq_exit_rcu() - Exit an interrupt context without updating RCU
644  *
645  * Also processes softirqs if needed and possible.
646  */
647 void irq_exit_rcu(void)
648 {
649 	__irq_exit_rcu();
650 	 /* must be last! */
651 	lockdep_hardirq_exit();
652 }
653 
654 /**
655  * irq_exit - Exit an interrupt context, update RCU and lockdep
656  *
657  * Also processes softirqs if needed and possible.
658  */
659 void irq_exit(void)
660 {
661 	__irq_exit_rcu();
662 	rcu_irq_exit();
663 	 /* must be last! */
664 	lockdep_hardirq_exit();
665 }
666 
667 /*
668  * This function must run with irqs disabled!
669  */
670 inline void raise_softirq_irqoff(unsigned int nr)
671 {
672 	__raise_softirq_irqoff(nr);
673 
674 	/*
675 	 * If we're in an interrupt or softirq, we're done
676 	 * (this also catches softirq-disabled code). We will
677 	 * actually run the softirq once we return from
678 	 * the irq or softirq.
679 	 *
680 	 * Otherwise we wake up ksoftirqd to make sure we
681 	 * schedule the softirq soon.
682 	 */
683 	if (!in_interrupt() && should_wake_ksoftirqd())
684 		wakeup_softirqd();
685 }
686 
687 void raise_softirq(unsigned int nr)
688 {
689 	unsigned long flags;
690 
691 	local_irq_save(flags);
692 	raise_softirq_irqoff(nr);
693 	local_irq_restore(flags);
694 }
695 
696 void __raise_softirq_irqoff(unsigned int nr)
697 {
698 	lockdep_assert_irqs_disabled();
699 	trace_softirq_raise(nr);
700 	or_softirq_pending(1UL << nr);
701 }
702 
703 void open_softirq(int nr, void (*action)(struct softirq_action *))
704 {
705 	softirq_vec[nr].action = action;
706 }
707 
708 /*
709  * Tasklets
710  */
711 struct tasklet_head {
712 	struct tasklet_struct *head;
713 	struct tasklet_struct **tail;
714 };
715 
716 static DEFINE_PER_CPU(struct tasklet_head, tasklet_vec);
717 static DEFINE_PER_CPU(struct tasklet_head, tasklet_hi_vec);
718 
719 static void __tasklet_schedule_common(struct tasklet_struct *t,
720 				      struct tasklet_head __percpu *headp,
721 				      unsigned int softirq_nr)
722 {
723 	struct tasklet_head *head;
724 	unsigned long flags;
725 
726 	local_irq_save(flags);
727 	head = this_cpu_ptr(headp);
728 	t->next = NULL;
729 	*head->tail = t;
730 	head->tail = &(t->next);
731 	raise_softirq_irqoff(softirq_nr);
732 	local_irq_restore(flags);
733 }
734 
735 void __tasklet_schedule(struct tasklet_struct *t)
736 {
737 	__tasklet_schedule_common(t, &tasklet_vec,
738 				  TASKLET_SOFTIRQ);
739 }
740 EXPORT_SYMBOL(__tasklet_schedule);
741 
742 void __tasklet_hi_schedule(struct tasklet_struct *t)
743 {
744 	__tasklet_schedule_common(t, &tasklet_hi_vec,
745 				  HI_SOFTIRQ);
746 }
747 EXPORT_SYMBOL(__tasklet_hi_schedule);
748 
749 static bool tasklet_clear_sched(struct tasklet_struct *t)
750 {
751 	if (test_and_clear_bit(TASKLET_STATE_SCHED, &t->state)) {
752 		wake_up_var(&t->state);
753 		return true;
754 	}
755 
756 	WARN_ONCE(1, "tasklet SCHED state not set: %s %pS\n",
757 		  t->use_callback ? "callback" : "func",
758 		  t->use_callback ? (void *)t->callback : (void *)t->func);
759 
760 	return false;
761 }
762 
763 static void tasklet_action_common(struct softirq_action *a,
764 				  struct tasklet_head *tl_head,
765 				  unsigned int softirq_nr)
766 {
767 	struct tasklet_struct *list;
768 
769 	local_irq_disable();
770 	list = tl_head->head;
771 	tl_head->head = NULL;
772 	tl_head->tail = &tl_head->head;
773 	local_irq_enable();
774 
775 	while (list) {
776 		struct tasklet_struct *t = list;
777 
778 		list = list->next;
779 
780 		if (tasklet_trylock(t)) {
781 			if (!atomic_read(&t->count)) {
782 				if (tasklet_clear_sched(t)) {
783 					if (t->use_callback)
784 						t->callback(t);
785 					else
786 						t->func(t->data);
787 				}
788 				tasklet_unlock(t);
789 				continue;
790 			}
791 			tasklet_unlock(t);
792 		}
793 
794 		local_irq_disable();
795 		t->next = NULL;
796 		*tl_head->tail = t;
797 		tl_head->tail = &t->next;
798 		__raise_softirq_irqoff(softirq_nr);
799 		local_irq_enable();
800 	}
801 }
802 
803 static __latent_entropy void tasklet_action(struct softirq_action *a)
804 {
805 	tasklet_action_common(a, this_cpu_ptr(&tasklet_vec), TASKLET_SOFTIRQ);
806 }
807 
808 static __latent_entropy void tasklet_hi_action(struct softirq_action *a)
809 {
810 	tasklet_action_common(a, this_cpu_ptr(&tasklet_hi_vec), HI_SOFTIRQ);
811 }
812 
813 void tasklet_setup(struct tasklet_struct *t,
814 		   void (*callback)(struct tasklet_struct *))
815 {
816 	t->next = NULL;
817 	t->state = 0;
818 	atomic_set(&t->count, 0);
819 	t->callback = callback;
820 	t->use_callback = true;
821 	t->data = 0;
822 }
823 EXPORT_SYMBOL(tasklet_setup);
824 
825 void tasklet_init(struct tasklet_struct *t,
826 		  void (*func)(unsigned long), unsigned long data)
827 {
828 	t->next = NULL;
829 	t->state = 0;
830 	atomic_set(&t->count, 0);
831 	t->func = func;
832 	t->use_callback = false;
833 	t->data = data;
834 }
835 EXPORT_SYMBOL(tasklet_init);
836 
837 #if defined(CONFIG_SMP) || defined(CONFIG_PREEMPT_RT)
838 /*
839  * Do not use in new code. Waiting for tasklets from atomic contexts is
840  * error prone and should be avoided.
841  */
842 void tasklet_unlock_spin_wait(struct tasklet_struct *t)
843 {
844 	while (test_bit(TASKLET_STATE_RUN, &(t)->state)) {
845 		if (IS_ENABLED(CONFIG_PREEMPT_RT)) {
846 			/*
847 			 * Prevent a live lock when current preempted soft
848 			 * interrupt processing or prevents ksoftirqd from
849 			 * running. If the tasklet runs on a different CPU
850 			 * then this has no effect other than doing the BH
851 			 * disable/enable dance for nothing.
852 			 */
853 			local_bh_disable();
854 			local_bh_enable();
855 		} else {
856 			cpu_relax();
857 		}
858 	}
859 }
860 EXPORT_SYMBOL(tasklet_unlock_spin_wait);
861 #endif
862 
863 void tasklet_kill(struct tasklet_struct *t)
864 {
865 	if (in_interrupt())
866 		pr_notice("Attempt to kill tasklet from interrupt\n");
867 
868 	while (test_and_set_bit(TASKLET_STATE_SCHED, &t->state))
869 		wait_var_event(&t->state, !test_bit(TASKLET_STATE_SCHED, &t->state));
870 
871 	tasklet_unlock_wait(t);
872 	tasklet_clear_sched(t);
873 }
874 EXPORT_SYMBOL(tasklet_kill);
875 
876 #if defined(CONFIG_SMP) || defined(CONFIG_PREEMPT_RT)
877 void tasklet_unlock(struct tasklet_struct *t)
878 {
879 	smp_mb__before_atomic();
880 	clear_bit(TASKLET_STATE_RUN, &t->state);
881 	smp_mb__after_atomic();
882 	wake_up_var(&t->state);
883 }
884 EXPORT_SYMBOL_GPL(tasklet_unlock);
885 
886 void tasklet_unlock_wait(struct tasklet_struct *t)
887 {
888 	wait_var_event(&t->state, !test_bit(TASKLET_STATE_RUN, &t->state));
889 }
890 EXPORT_SYMBOL_GPL(tasklet_unlock_wait);
891 #endif
892 
893 void __init softirq_init(void)
894 {
895 	int cpu;
896 
897 	for_each_possible_cpu(cpu) {
898 		per_cpu(tasklet_vec, cpu).tail =
899 			&per_cpu(tasklet_vec, cpu).head;
900 		per_cpu(tasklet_hi_vec, cpu).tail =
901 			&per_cpu(tasklet_hi_vec, cpu).head;
902 	}
903 
904 	open_softirq(TASKLET_SOFTIRQ, tasklet_action);
905 	open_softirq(HI_SOFTIRQ, tasklet_hi_action);
906 }
907 
908 static int ksoftirqd_should_run(unsigned int cpu)
909 {
910 	return local_softirq_pending();
911 }
912 
913 static void run_ksoftirqd(unsigned int cpu)
914 {
915 	ksoftirqd_run_begin();
916 	if (local_softirq_pending()) {
917 		/*
918 		 * We can safely run softirq on inline stack, as we are not deep
919 		 * in the task stack here.
920 		 */
921 		__do_softirq();
922 		ksoftirqd_run_end();
923 		cond_resched();
924 		return;
925 	}
926 	ksoftirqd_run_end();
927 }
928 
929 #ifdef CONFIG_HOTPLUG_CPU
930 static int takeover_tasklets(unsigned int cpu)
931 {
932 	/* CPU is dead, so no lock needed. */
933 	local_irq_disable();
934 
935 	/* Find end, append list for that CPU. */
936 	if (&per_cpu(tasklet_vec, cpu).head != per_cpu(tasklet_vec, cpu).tail) {
937 		*__this_cpu_read(tasklet_vec.tail) = per_cpu(tasklet_vec, cpu).head;
938 		__this_cpu_write(tasklet_vec.tail, per_cpu(tasklet_vec, cpu).tail);
939 		per_cpu(tasklet_vec, cpu).head = NULL;
940 		per_cpu(tasklet_vec, cpu).tail = &per_cpu(tasklet_vec, cpu).head;
941 	}
942 	raise_softirq_irqoff(TASKLET_SOFTIRQ);
943 
944 	if (&per_cpu(tasklet_hi_vec, cpu).head != per_cpu(tasklet_hi_vec, cpu).tail) {
945 		*__this_cpu_read(tasklet_hi_vec.tail) = per_cpu(tasklet_hi_vec, cpu).head;
946 		__this_cpu_write(tasklet_hi_vec.tail, per_cpu(tasklet_hi_vec, cpu).tail);
947 		per_cpu(tasklet_hi_vec, cpu).head = NULL;
948 		per_cpu(tasklet_hi_vec, cpu).tail = &per_cpu(tasklet_hi_vec, cpu).head;
949 	}
950 	raise_softirq_irqoff(HI_SOFTIRQ);
951 
952 	local_irq_enable();
953 	return 0;
954 }
955 #else
956 #define takeover_tasklets	NULL
957 #endif /* CONFIG_HOTPLUG_CPU */
958 
959 static struct smp_hotplug_thread softirq_threads = {
960 	.store			= &ksoftirqd,
961 	.thread_should_run	= ksoftirqd_should_run,
962 	.thread_fn		= run_ksoftirqd,
963 	.thread_comm		= "ksoftirqd/%u",
964 };
965 
966 static __init int spawn_ksoftirqd(void)
967 {
968 	cpuhp_setup_state_nocalls(CPUHP_SOFTIRQ_DEAD, "softirq:dead", NULL,
969 				  takeover_tasklets);
970 	BUG_ON(smpboot_register_percpu_thread(&softirq_threads));
971 
972 	return 0;
973 }
974 early_initcall(spawn_ksoftirqd);
975 
976 /*
977  * [ These __weak aliases are kept in a separate compilation unit, so that
978  *   GCC does not inline them incorrectly. ]
979  */
980 
981 int __init __weak early_irq_init(void)
982 {
983 	return 0;
984 }
985 
986 int __init __weak arch_probe_nr_irqs(void)
987 {
988 	return NR_IRQS_LEGACY;
989 }
990 
991 int __init __weak arch_early_irq_init(void)
992 {
993 	return 0;
994 }
995 
996 unsigned int __weak arch_dynirq_lower_bound(unsigned int from)
997 {
998 	return from;
999 }
1000