Guenter Roeck | d017327 | 2019-06-20 09:28:46 -0700 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | /* |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 3 | * SoftDog: A Software Watchdog Device |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4 | * |
Wim Van Sebroeck | 143a2e5 | 2009-03-18 08:35:09 +0000 | [diff] [blame] | 5 | * (c) Copyright 1996 Alan Cox <alan@lxorguk.ukuu.org.uk>, |
| 6 | * All Rights Reserved. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 7 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 8 | * Neither Alan Cox nor CymruNet Ltd. admit liability nor provide |
| 9 | * warranty for any of this software. This material is provided |
| 10 | * "AS-IS" and at no charge. |
| 11 | * |
| 12 | * (c) Copyright 1995 Alan Cox <alan@lxorguk.ukuu.org.uk> |
| 13 | * |
| 14 | * Software only watchdog driver. Unlike its big brother the WDT501P |
| 15 | * driver this won't always recover a failed machine. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | */ |
| 17 | |
Joe Perches | 27c766a | 2012-02-15 15:06:19 -0800 | [diff] [blame] | 18 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| 19 | |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 20 | #include <linux/hrtimer.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 21 | #include <linux/init.h> |
Anithra P Janakiraman | 7fff4be | 2011-03-28 14:29:19 -0700 | [diff] [blame] | 22 | #include <linux/kernel.h> |
Woody Lin | 36a8947 | 2020-07-08 16:32:19 +0800 | [diff] [blame] | 23 | #include <linux/kthread.h> |
Wolfram Sang | e65c582 | 2016-05-25 08:37:47 +0200 | [diff] [blame] | 24 | #include <linux/module.h> |
| 25 | #include <linux/moduleparam.h> |
| 26 | #include <linux/reboot.h> |
Wolfram Sang | e65c582 | 2016-05-25 08:37:47 +0200 | [diff] [blame] | 27 | #include <linux/types.h> |
| 28 | #include <linux/watchdog.h> |
Woody Lin | 36a8947 | 2020-07-08 16:32:19 +0800 | [diff] [blame] | 29 | #include <linux/workqueue.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | #define TIMER_MARGIN 60 /* Default is 60 seconds */ |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 32 | static unsigned int soft_margin = TIMER_MARGIN; /* in seconds */ |
| 33 | module_param(soft_margin, uint, 0); |
Alan Cox | f92d374 | 2008-05-19 14:09:06 +0100 | [diff] [blame] | 34 | MODULE_PARM_DESC(soft_margin, |
| 35 | "Watchdog soft_margin in seconds. (0 < soft_margin < 65536, default=" |
| 36 | __MODULE_STRING(TIMER_MARGIN) ")"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | |
Wim Van Sebroeck | 86a1e18 | 2012-03-05 16:51:11 +0100 | [diff] [blame] | 38 | static bool nowayout = WATCHDOG_NOWAYOUT; |
| 39 | module_param(nowayout, bool, 0); |
Alan Cox | f92d374 | 2008-05-19 14:09:06 +0100 | [diff] [blame] | 40 | MODULE_PARM_DESC(nowayout, |
| 41 | "Watchdog cannot be stopped once started (default=" |
| 42 | __MODULE_STRING(WATCHDOG_NOWAYOUT) ")"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | |
Jingoo Han | 5f5e190 | 2014-02-27 14:41:42 +0900 | [diff] [blame] | 44 | static int soft_noboot; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 45 | module_param(soft_noboot, int, 0); |
Wim Van Sebroeck | a77dba7 | 2009-04-14 20:20:07 +0000 | [diff] [blame] | 46 | MODULE_PARM_DESC(soft_noboot, |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 47 | "Softdog action, set to 1 to ignore reboots, 0 to reboot (default=0)"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | |
Anithra P Janakiraman | 7fff4be | 2011-03-28 14:29:19 -0700 | [diff] [blame] | 49 | static int soft_panic; |
| 50 | module_param(soft_panic, int, 0); |
| 51 | MODULE_PARM_DESC(soft_panic, |
| 52 | "Softdog action, set to 1 to panic, 0 to reboot (default=0)"); |
| 53 | |
Woody Lin | 36a8947 | 2020-07-08 16:32:19 +0800 | [diff] [blame] | 54 | static char *soft_reboot_cmd; |
| 55 | module_param(soft_reboot_cmd, charp, 0000); |
| 56 | MODULE_PARM_DESC(soft_reboot_cmd, |
| 57 | "Set reboot command. Emergency reboot takes place if unset"); |
| 58 | |
| 59 | static bool soft_active_on_boot; |
| 60 | module_param(soft_active_on_boot, bool, 0000); |
| 61 | MODULE_PARM_DESC(soft_active_on_boot, |
| 62 | "Set to true to active Softdog on boot (default=false)"); |
| 63 | |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 64 | static struct hrtimer softdog_ticktock; |
| 65 | static struct hrtimer softdog_preticktock; |
| 66 | |
Woody Lin | 36a8947 | 2020-07-08 16:32:19 +0800 | [diff] [blame] | 67 | static int reboot_kthread_fn(void *data) |
| 68 | { |
| 69 | kernel_restart(soft_reboot_cmd); |
| 70 | return -EPERM; /* Should not reach here */ |
| 71 | } |
| 72 | |
| 73 | static void reboot_work_fn(struct work_struct *unused) |
| 74 | { |
| 75 | kthread_run(reboot_kthread_fn, NULL, "softdog_reboot"); |
| 76 | } |
| 77 | |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 78 | static enum hrtimer_restart softdog_fire(struct hrtimer *timer) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 79 | { |
Woody Lin | 36a8947 | 2020-07-08 16:32:19 +0800 | [diff] [blame] | 80 | static bool soft_reboot_fired; |
| 81 | |
Li RongQing | 5889f06 | 2015-12-17 21:30:02 +0800 | [diff] [blame] | 82 | module_put(THIS_MODULE); |
Wolfram Sang | 4a23e2b | 2016-05-25 08:37:49 +0200 | [diff] [blame] | 83 | if (soft_noboot) { |
Joe Perches | 27c766a | 2012-02-15 15:06:19 -0800 | [diff] [blame] | 84 | pr_crit("Triggered - Reboot ignored\n"); |
Wolfram Sang | 4a23e2b | 2016-05-25 08:37:49 +0200 | [diff] [blame] | 85 | } else if (soft_panic) { |
Joe Perches | 27c766a | 2012-02-15 15:06:19 -0800 | [diff] [blame] | 86 | pr_crit("Initiating panic\n"); |
| 87 | panic("Software Watchdog Timer expired"); |
Anithra P Janakiraman | 7fff4be | 2011-03-28 14:29:19 -0700 | [diff] [blame] | 88 | } else { |
Joe Perches | 27c766a | 2012-02-15 15:06:19 -0800 | [diff] [blame] | 89 | pr_crit("Initiating system reboot\n"); |
Woody Lin | 36a8947 | 2020-07-08 16:32:19 +0800 | [diff] [blame] | 90 | if (!soft_reboot_fired && soft_reboot_cmd != NULL) { |
| 91 | static DECLARE_WORK(reboot_work, reboot_work_fn); |
| 92 | /* |
| 93 | * The 'kernel_restart' is a 'might-sleep' operation. |
| 94 | * Also, executing it in system-wide workqueues blocks |
| 95 | * any driver from using the same workqueue in its |
| 96 | * shutdown callback function. Thus, we should execute |
| 97 | * the 'kernel_restart' in a standalone kernel thread. |
| 98 | * But since starting a kernel thread is also a |
| 99 | * 'might-sleep' operation, so the 'reboot_work' is |
| 100 | * required as a launcher of the kernel thread. |
| 101 | * |
| 102 | * After request the reboot, restart the timer to |
| 103 | * schedule an 'emergency_restart' reboot after |
| 104 | * 'TIMER_MARGIN' seconds. It's because if the softdog |
| 105 | * hangs, it might be because of scheduling issues. And |
| 106 | * if that is the case, both 'schedule_work' and |
| 107 | * 'kernel_restart' may possibly be malfunctional at the |
| 108 | * same time. |
| 109 | */ |
| 110 | soft_reboot_fired = true; |
| 111 | schedule_work(&reboot_work); |
| 112 | hrtimer_add_expires_ns(timer, |
| 113 | (u64)TIMER_MARGIN * NSEC_PER_SEC); |
| 114 | |
| 115 | return HRTIMER_RESTART; |
| 116 | } |
Andrew Morton | 479d0f4 | 2005-07-26 21:41:38 -0700 | [diff] [blame] | 117 | emergency_restart(); |
Joe Perches | 27c766a | 2012-02-15 15:06:19 -0800 | [diff] [blame] | 118 | pr_crit("Reboot didn't ?????\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 119 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 120 | |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 121 | return HRTIMER_NORESTART; |
| 122 | } |
Wolfram Sang | 44ba0f0 | 2016-05-25 08:37:46 +0200 | [diff] [blame] | 123 | |
Wolfram Sang | 2accf32 | 2016-10-07 15:41:38 +0300 | [diff] [blame] | 124 | static struct watchdog_device softdog_dev; |
| 125 | |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 126 | static enum hrtimer_restart softdog_pretimeout(struct hrtimer *timer) |
Wolfram Sang | 2accf32 | 2016-10-07 15:41:38 +0300 | [diff] [blame] | 127 | { |
| 128 | watchdog_notify_pretimeout(&softdog_dev); |
Wolfram Sang | 2accf32 | 2016-10-07 15:41:38 +0300 | [diff] [blame] | 129 | |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 130 | return HRTIMER_NORESTART; |
| 131 | } |
Wolfram Sang | 2accf32 | 2016-10-07 15:41:38 +0300 | [diff] [blame] | 132 | |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 133 | static int softdog_ping(struct watchdog_device *w) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 134 | { |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 135 | if (!hrtimer_active(&softdog_ticktock)) |
Li RongQing | 5889f06 | 2015-12-17 21:30:02 +0800 | [diff] [blame] | 136 | __module_get(THIS_MODULE); |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 137 | hrtimer_start(&softdog_ticktock, ktime_set(w->timeout, 0), |
| 138 | HRTIMER_MODE_REL); |
Wolfram Sang | 2accf32 | 2016-10-07 15:41:38 +0300 | [diff] [blame] | 139 | |
Wolfram Sang | 4cbc690 | 2017-02-07 15:03:29 +0100 | [diff] [blame] | 140 | if (IS_ENABLED(CONFIG_SOFT_WATCHDOG_PRETIMEOUT)) { |
| 141 | if (w->pretimeout) |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 142 | hrtimer_start(&softdog_preticktock, |
| 143 | ktime_set(w->timeout - w->pretimeout, 0), |
| 144 | HRTIMER_MODE_REL); |
Wolfram Sang | 4cbc690 | 2017-02-07 15:03:29 +0100 | [diff] [blame] | 145 | else |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 146 | hrtimer_cancel(&softdog_preticktock); |
Wolfram Sang | 4cbc690 | 2017-02-07 15:03:29 +0100 | [diff] [blame] | 147 | } |
Wolfram Sang | 2accf32 | 2016-10-07 15:41:38 +0300 | [diff] [blame] | 148 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 149 | return 0; |
| 150 | } |
| 151 | |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 152 | static int softdog_stop(struct watchdog_device *w) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 153 | { |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 154 | if (hrtimer_cancel(&softdog_ticktock)) |
Li RongQing | 5889f06 | 2015-12-17 21:30:02 +0800 | [diff] [blame] | 155 | module_put(THIS_MODULE); |
| 156 | |
Wolfram Sang | 4cbc690 | 2017-02-07 15:03:29 +0100 | [diff] [blame] | 157 | if (IS_ENABLED(CONFIG_SOFT_WATCHDOG_PRETIMEOUT)) |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 158 | hrtimer_cancel(&softdog_preticktock); |
Wolfram Sang | 2accf32 | 2016-10-07 15:41:38 +0300 | [diff] [blame] | 159 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 160 | return 0; |
| 161 | } |
| 162 | |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 163 | static struct watchdog_info softdog_info = { |
| 164 | .identity = "Software Watchdog", |
Wolfram Sang | 4cbc690 | 2017-02-07 15:03:29 +0100 | [diff] [blame] | 165 | .options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING | WDIOF_MAGICCLOSE, |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 166 | }; |
| 167 | |
Julia Lawall | 85f15cf | 2016-09-01 19:35:26 +0200 | [diff] [blame] | 168 | static const struct watchdog_ops softdog_ops = { |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 169 | .owner = THIS_MODULE, |
| 170 | .start = softdog_ping, |
| 171 | .stop = softdog_stop, |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 172 | }; |
| 173 | |
| 174 | static struct watchdog_device softdog_dev = { |
| 175 | .info = &softdog_info, |
| 176 | .ops = &softdog_ops, |
| 177 | .min_timeout = 1, |
Wolfram Sang | e8cf96a | 2016-05-25 08:37:44 +0200 | [diff] [blame] | 178 | .max_timeout = 65535, |
| 179 | .timeout = TIMER_MARGIN, |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 180 | }; |
| 181 | |
Wolfram Sang | 0efc70b | 2016-05-25 08:37:45 +0200 | [diff] [blame] | 182 | static int __init softdog_init(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 183 | { |
| 184 | int ret; |
| 185 | |
Wolfram Sang | e8cf96a | 2016-05-25 08:37:44 +0200 | [diff] [blame] | 186 | watchdog_init_timeout(&softdog_dev, soft_margin, NULL); |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 187 | watchdog_set_nowayout(&softdog_dev, nowayout); |
Damien Riegel | 84ebcc1 | 2015-11-20 16:54:55 -0500 | [diff] [blame] | 188 | watchdog_stop_on_reboot(&softdog_dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 189 | |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 190 | hrtimer_init(&softdog_ticktock, CLOCK_MONOTONIC, HRTIMER_MODE_REL); |
| 191 | softdog_ticktock.function = softdog_fire; |
| 192 | |
| 193 | if (IS_ENABLED(CONFIG_SOFT_WATCHDOG_PRETIMEOUT)) { |
Wolfram Sang | 4cbc690 | 2017-02-07 15:03:29 +0100 | [diff] [blame] | 194 | softdog_info.options |= WDIOF_PRETIMEOUT; |
Niklas Cassel | 8d5755b | 2017-02-27 13:49:09 +0100 | [diff] [blame] | 195 | hrtimer_init(&softdog_preticktock, CLOCK_MONOTONIC, |
| 196 | HRTIMER_MODE_REL); |
| 197 | softdog_preticktock.function = softdog_pretimeout; |
| 198 | } |
Wolfram Sang | 4cbc690 | 2017-02-07 15:03:29 +0100 | [diff] [blame] | 199 | |
Woody Lin | 36a8947 | 2020-07-08 16:32:19 +0800 | [diff] [blame] | 200 | if (soft_active_on_boot) |
| 201 | softdog_ping(&softdog_dev); |
| 202 | |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 203 | ret = watchdog_register_device(&softdog_dev); |
Damien Riegel | 84ebcc1 | 2015-11-20 16:54:55 -0500 | [diff] [blame] | 204 | if (ret) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 205 | return ret; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 206 | |
Wolfram Sang | e8cf96a | 2016-05-25 08:37:44 +0200 | [diff] [blame] | 207 | pr_info("initialized. soft_noboot=%d soft_margin=%d sec soft_panic=%d (nowayout=%d)\n", |
| 208 | soft_noboot, softdog_dev.timeout, soft_panic, nowayout); |
Woody Lin | 36a8947 | 2020-07-08 16:32:19 +0800 | [diff] [blame] | 209 | pr_info(" soft_reboot_cmd=%s soft_active_on_boot=%d\n", |
| 210 | soft_reboot_cmd ?: "<not set>", soft_active_on_boot); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 211 | |
| 212 | return 0; |
| 213 | } |
Wolfram Sang | 0efc70b | 2016-05-25 08:37:45 +0200 | [diff] [blame] | 214 | module_init(softdog_init); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 215 | |
Wolfram Sang | 0efc70b | 2016-05-25 08:37:45 +0200 | [diff] [blame] | 216 | static void __exit softdog_exit(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 217 | { |
Alan Cox | a5132ca | 2012-02-28 22:48:11 +0000 | [diff] [blame] | 218 | watchdog_unregister_device(&softdog_dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 219 | } |
Wolfram Sang | 0efc70b | 2016-05-25 08:37:45 +0200 | [diff] [blame] | 220 | module_exit(softdog_exit); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 221 | |
| 222 | MODULE_AUTHOR("Alan Cox"); |
| 223 | MODULE_DESCRIPTION("Software Watchdog Device Driver"); |
| 224 | MODULE_LICENSE("GPL"); |