This source file includes following definitions.
- wd_smp_lock
- wd_smp_unlock
- wd_lockup_ipi
- set_cpumask_stuck
- set_cpu_stuck
- watchdog_smp_panic
- wd_smp_clear_cpu_pending
- watchdog_timer_interrupt
- soft_nmi_interrupt
- watchdog_timer_fn
- arch_touch_nmi_watchdog
- start_watchdog
- start_watchdog_on_cpu
- stop_watchdog
- stop_watchdog_on_cpu
- watchdog_calc_timeouts
- watchdog_nmi_stop
- watchdog_nmi_start
- watchdog_nmi_probe
   1 
   2 
   3 
   4 
   5 
   6 
   7 
   8 
   9 
  10 #define pr_fmt(fmt) "watchdog: " fmt
  11 
  12 #include <linux/kernel.h>
  13 #include <linux/param.h>
  14 #include <linux/init.h>
  15 #include <linux/percpu.h>
  16 #include <linux/cpu.h>
  17 #include <linux/nmi.h>
  18 #include <linux/module.h>
  19 #include <linux/export.h>
  20 #include <linux/kprobes.h>
  21 #include <linux/hardirq.h>
  22 #include <linux/reboot.h>
  23 #include <linux/slab.h>
  24 #include <linux/kdebug.h>
  25 #include <linux/sched/debug.h>
  26 #include <linux/delay.h>
  27 #include <linux/smp.h>
  28 
  29 #include <asm/paca.h>
  30 
  31 
  32 
  33 
  34 
  35 
  36 
  37 
  38 
  39 
  40 
  41 
  42 
  43 
  44 
  45 
  46 
  47 
  48 
  49 
  50 
  51 
  52 
  53 
  54 
  55 
  56 
  57 
  58 
  59 
  60 
  61 
  62 
  63 
  64 
  65 
  66 
  67 
  68 
  69 
  70 
  71 
  72 
  73 static cpumask_t wd_cpus_enabled __read_mostly;
  74 
  75 static u64 wd_panic_timeout_tb __read_mostly; 
  76 static u64 wd_smp_panic_timeout_tb __read_mostly; 
  77 
  78 static u64 wd_timer_period_ms __read_mostly;  
  79 
  80 static DEFINE_PER_CPU(struct hrtimer, wd_hrtimer);
  81 static DEFINE_PER_CPU(u64, wd_timer_tb);
  82 
  83 
  84 static unsigned long __wd_smp_lock;
  85 static cpumask_t wd_smp_cpus_pending;
  86 static cpumask_t wd_smp_cpus_stuck;
  87 static u64 wd_smp_last_reset_tb;
  88 
  89 static inline void wd_smp_lock(unsigned long *flags)
  90 {
  91         
  92 
  93 
  94 
  95 
  96         raw_local_irq_save(*flags);
  97         hard_irq_disable(); 
  98         while (unlikely(test_and_set_bit_lock(0, &__wd_smp_lock))) {
  99                 raw_local_irq_restore(*flags);
 100                 spin_until_cond(!test_bit(0, &__wd_smp_lock));
 101                 raw_local_irq_save(*flags);
 102                 hard_irq_disable();
 103         }
 104 }
 105 
 106 static inline void wd_smp_unlock(unsigned long *flags)
 107 {
 108         clear_bit_unlock(0, &__wd_smp_lock);
 109         raw_local_irq_restore(*flags);
 110 }
 111 
 112 static void wd_lockup_ipi(struct pt_regs *regs)
 113 {
 114         int cpu = raw_smp_processor_id();
 115         u64 tb = get_tb();
 116 
 117         pr_emerg("CPU %d Hard LOCKUP\n", cpu);
 118         pr_emerg("CPU %d TB:%lld, last heartbeat TB:%lld (%lldms ago)\n",
 119                  cpu, tb, per_cpu(wd_timer_tb, cpu),
 120                  tb_to_ns(tb - per_cpu(wd_timer_tb, cpu)) / 1000000);
 121         print_modules();
 122         print_irqtrace_events(current);
 123         if (regs)
 124                 show_regs(regs);
 125         else
 126                 dump_stack();
 127 
 128         
 129 }
 130 
 131 static void set_cpumask_stuck(const struct cpumask *cpumask, u64 tb)
 132 {
 133         cpumask_or(&wd_smp_cpus_stuck, &wd_smp_cpus_stuck, cpumask);
 134         cpumask_andnot(&wd_smp_cpus_pending, &wd_smp_cpus_pending, cpumask);
 135         if (cpumask_empty(&wd_smp_cpus_pending)) {
 136                 wd_smp_last_reset_tb = tb;
 137                 cpumask_andnot(&wd_smp_cpus_pending,
 138                                 &wd_cpus_enabled,
 139                                 &wd_smp_cpus_stuck);
 140         }
 141 }
 142 static void set_cpu_stuck(int cpu, u64 tb)
 143 {
 144         set_cpumask_stuck(cpumask_of(cpu), tb);
 145 }
 146 
 147 static void watchdog_smp_panic(int cpu, u64 tb)
 148 {
 149         unsigned long flags;
 150         int c;
 151 
 152         wd_smp_lock(&flags);
 153         
 154         if ((s64)(tb - wd_smp_last_reset_tb) < (s64)wd_smp_panic_timeout_tb)
 155                 goto out;
 156         if (cpumask_test_cpu(cpu, &wd_smp_cpus_pending))
 157                 goto out;
 158         if (cpumask_weight(&wd_smp_cpus_pending) == 0)
 159                 goto out;
 160 
 161         pr_emerg("CPU %d detected hard LOCKUP on other CPUs %*pbl\n",
 162                  cpu, cpumask_pr_args(&wd_smp_cpus_pending));
 163         pr_emerg("CPU %d TB:%lld, last SMP heartbeat TB:%lld (%lldms ago)\n",
 164                  cpu, tb, wd_smp_last_reset_tb,
 165                  tb_to_ns(tb - wd_smp_last_reset_tb) / 1000000);
 166 
 167         if (!sysctl_hardlockup_all_cpu_backtrace) {
 168                 
 169 
 170 
 171 
 172                 for_each_cpu(c, &wd_smp_cpus_pending) {
 173                         if (c == cpu)
 174                                 continue;
 175                         smp_send_nmi_ipi(c, wd_lockup_ipi, 1000000);
 176                 }
 177         }
 178 
 179         
 180         set_cpumask_stuck(&wd_smp_cpus_pending, tb);
 181 
 182         wd_smp_unlock(&flags);
 183 
 184         printk_safe_flush();
 185         
 186 
 187 
 188 
 189         if (sysctl_hardlockup_all_cpu_backtrace)
 190                 trigger_allbutself_cpu_backtrace();
 191 
 192         if (hardlockup_panic)
 193                 nmi_panic(NULL, "Hard LOCKUP");
 194 
 195         return;
 196 
 197 out:
 198         wd_smp_unlock(&flags);
 199 }
 200 
 201 static void wd_smp_clear_cpu_pending(int cpu, u64 tb)
 202 {
 203         if (!cpumask_test_cpu(cpu, &wd_smp_cpus_pending)) {
 204                 if (unlikely(cpumask_test_cpu(cpu, &wd_smp_cpus_stuck))) {
 205                         struct pt_regs *regs = get_irq_regs();
 206                         unsigned long flags;
 207 
 208                         wd_smp_lock(&flags);
 209 
 210                         pr_emerg("CPU %d became unstuck TB:%lld\n",
 211                                  cpu, tb);
 212                         print_irqtrace_events(current);
 213                         if (regs)
 214                                 show_regs(regs);
 215                         else
 216                                 dump_stack();
 217 
 218                         cpumask_clear_cpu(cpu, &wd_smp_cpus_stuck);
 219                         wd_smp_unlock(&flags);
 220                 }
 221                 return;
 222         }
 223         cpumask_clear_cpu(cpu, &wd_smp_cpus_pending);
 224         if (cpumask_empty(&wd_smp_cpus_pending)) {
 225                 unsigned long flags;
 226 
 227                 wd_smp_lock(&flags);
 228                 if (cpumask_empty(&wd_smp_cpus_pending)) {
 229                         wd_smp_last_reset_tb = tb;
 230                         cpumask_andnot(&wd_smp_cpus_pending,
 231                                         &wd_cpus_enabled,
 232                                         &wd_smp_cpus_stuck);
 233                 }
 234                 wd_smp_unlock(&flags);
 235         }
 236 }
 237 
 238 static void watchdog_timer_interrupt(int cpu)
 239 {
 240         u64 tb = get_tb();
 241 
 242         per_cpu(wd_timer_tb, cpu) = tb;
 243 
 244         wd_smp_clear_cpu_pending(cpu, tb);
 245 
 246         if ((s64)(tb - wd_smp_last_reset_tb) >= (s64)wd_smp_panic_timeout_tb)
 247                 watchdog_smp_panic(cpu, tb);
 248 }
 249 
 250 void soft_nmi_interrupt(struct pt_regs *regs)
 251 {
 252         unsigned long flags;
 253         int cpu = raw_smp_processor_id();
 254         u64 tb;
 255 
 256         if (!cpumask_test_cpu(cpu, &wd_cpus_enabled))
 257                 return;
 258 
 259         nmi_enter();
 260 
 261         __this_cpu_inc(irq_stat.soft_nmi_irqs);
 262 
 263         tb = get_tb();
 264         if (tb - per_cpu(wd_timer_tb, cpu) >= wd_panic_timeout_tb) {
 265                 wd_smp_lock(&flags);
 266                 if (cpumask_test_cpu(cpu, &wd_smp_cpus_stuck)) {
 267                         wd_smp_unlock(&flags);
 268                         goto out;
 269                 }
 270                 set_cpu_stuck(cpu, tb);
 271 
 272                 pr_emerg("CPU %d self-detected hard LOCKUP @ %pS\n",
 273                          cpu, (void *)regs->nip);
 274                 pr_emerg("CPU %d TB:%lld, last heartbeat TB:%lld (%lldms ago)\n",
 275                          cpu, tb, per_cpu(wd_timer_tb, cpu),
 276                          tb_to_ns(tb - per_cpu(wd_timer_tb, cpu)) / 1000000);
 277                 print_modules();
 278                 print_irqtrace_events(current);
 279                 show_regs(regs);
 280 
 281                 wd_smp_unlock(&flags);
 282 
 283                 if (sysctl_hardlockup_all_cpu_backtrace)
 284                         trigger_allbutself_cpu_backtrace();
 285 
 286                 if (hardlockup_panic)
 287                         nmi_panic(regs, "Hard LOCKUP");
 288         }
 289         if (wd_panic_timeout_tb < 0x7fffffff)
 290                 mtspr(SPRN_DEC, wd_panic_timeout_tb);
 291 
 292 out:
 293         nmi_exit();
 294 }
 295 
 296 static enum hrtimer_restart watchdog_timer_fn(struct hrtimer *hrtimer)
 297 {
 298         int cpu = smp_processor_id();
 299 
 300         if (!(watchdog_enabled & NMI_WATCHDOG_ENABLED))
 301                 return HRTIMER_NORESTART;
 302 
 303         if (!cpumask_test_cpu(cpu, &watchdog_cpumask))
 304                 return HRTIMER_NORESTART;
 305 
 306         watchdog_timer_interrupt(cpu);
 307 
 308         hrtimer_forward_now(hrtimer, ms_to_ktime(wd_timer_period_ms));
 309 
 310         return HRTIMER_RESTART;
 311 }
 312 
 313 void arch_touch_nmi_watchdog(void)
 314 {
 315         unsigned long ticks = tb_ticks_per_usec * wd_timer_period_ms * 1000;
 316         int cpu = smp_processor_id();
 317         u64 tb = get_tb();
 318 
 319         if (tb - per_cpu(wd_timer_tb, cpu) >= ticks) {
 320                 per_cpu(wd_timer_tb, cpu) = tb;
 321                 wd_smp_clear_cpu_pending(cpu, tb);
 322         }
 323 }
 324 EXPORT_SYMBOL(arch_touch_nmi_watchdog);
 325 
 326 static void start_watchdog(void *arg)
 327 {
 328         struct hrtimer *hrtimer = this_cpu_ptr(&wd_hrtimer);
 329         int cpu = smp_processor_id();
 330         unsigned long flags;
 331 
 332         if (cpumask_test_cpu(cpu, &wd_cpus_enabled)) {
 333                 WARN_ON(1);
 334                 return;
 335         }
 336 
 337         if (!(watchdog_enabled & NMI_WATCHDOG_ENABLED))
 338                 return;
 339 
 340         if (!cpumask_test_cpu(cpu, &watchdog_cpumask))
 341                 return;
 342 
 343         wd_smp_lock(&flags);
 344         cpumask_set_cpu(cpu, &wd_cpus_enabled);
 345         if (cpumask_weight(&wd_cpus_enabled) == 1) {
 346                 cpumask_set_cpu(cpu, &wd_smp_cpus_pending);
 347                 wd_smp_last_reset_tb = get_tb();
 348         }
 349         wd_smp_unlock(&flags);
 350 
 351         *this_cpu_ptr(&wd_timer_tb) = get_tb();
 352 
 353         hrtimer_init(hrtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
 354         hrtimer->function = watchdog_timer_fn;
 355         hrtimer_start(hrtimer, ms_to_ktime(wd_timer_period_ms),
 356                       HRTIMER_MODE_REL_PINNED);
 357 }
 358 
 359 static int start_watchdog_on_cpu(unsigned int cpu)
 360 {
 361         return smp_call_function_single(cpu, start_watchdog, NULL, true);
 362 }
 363 
 364 static void stop_watchdog(void *arg)
 365 {
 366         struct hrtimer *hrtimer = this_cpu_ptr(&wd_hrtimer);
 367         int cpu = smp_processor_id();
 368         unsigned long flags;
 369 
 370         if (!cpumask_test_cpu(cpu, &wd_cpus_enabled))
 371                 return; 
 372 
 373         hrtimer_cancel(hrtimer);
 374 
 375         wd_smp_lock(&flags);
 376         cpumask_clear_cpu(cpu, &wd_cpus_enabled);
 377         wd_smp_unlock(&flags);
 378 
 379         wd_smp_clear_cpu_pending(cpu, get_tb());
 380 }
 381 
 382 static int stop_watchdog_on_cpu(unsigned int cpu)
 383 {
 384         return smp_call_function_single(cpu, stop_watchdog, NULL, true);
 385 }
 386 
 387 static void watchdog_calc_timeouts(void)
 388 {
 389         wd_panic_timeout_tb = watchdog_thresh * ppc_tb_freq;
 390 
 391         
 392         wd_smp_panic_timeout_tb = wd_panic_timeout_tb * 3 / 2;
 393 
 394         
 395         wd_timer_period_ms = watchdog_thresh * 1000 * 2 / 5;
 396 }
 397 
 398 void watchdog_nmi_stop(void)
 399 {
 400         int cpu;
 401 
 402         for_each_cpu(cpu, &wd_cpus_enabled)
 403                 stop_watchdog_on_cpu(cpu);
 404 }
 405 
 406 void watchdog_nmi_start(void)
 407 {
 408         int cpu;
 409 
 410         watchdog_calc_timeouts();
 411         for_each_cpu_and(cpu, cpu_online_mask, &watchdog_cpumask)
 412                 start_watchdog_on_cpu(cpu);
 413 }
 414 
 415 
 416 
 417 
 418 int __init watchdog_nmi_probe(void)
 419 {
 420         int err;
 421 
 422         err = cpuhp_setup_state_nocalls(CPUHP_AP_ONLINE_DYN,
 423                                         "powerpc/watchdog:online",
 424                                         start_watchdog_on_cpu,
 425                                         stop_watchdog_on_cpu);
 426         if (err < 0) {
 427                 pr_warn("could not be initialized");
 428                 return err;
 429         }
 430         return 0;
 431 }