kernel/softirq.c

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