Quelle  softdog.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0+
/*
 * SoftDog: A Software Watchdog Device
 *
 * (c) Copyright 1996 Alan Cox <alan@lxorguk.ukuu.org.uk>,
 *       All Rights Reserved.
 *
 * Neither Alan Cox nor CymruNet Ltd. admit liability nor provide
 * warranty for any of this software. This material is provided
 * "AS-IS" and at no charge.
 *
 * (c) Copyright 1995    Alan Cox <alan@lxorguk.ukuu.org.uk>
 *
 * Software only watchdog driver. Unlike its big brother the WDT501P
 * driver this won't always recover a failed machine.
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/hrtimer.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/kthread.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/reboot.h>
#include <linux/types.h>
#include <linux/watchdog.h>
#include <linux/workqueue.h>

#define TIMER_MARGIN 60  /* Default is 60 seconds */
static unsigned int soft_margin = TIMER_MARGIN; /* in seconds */
module_param(soft_margin, uint, 0);
MODULE_PARM_DESC(soft_margin,
 "Watchdog soft_margin in seconds. (0 < soft_margin < 65536, default="
     __MODULE_STRING(TIMER_MARGIN) ")");

static bool nowayout = WATCHDOG_NOWAYOUT;
module_param(nowayout, bool, 0);
MODULE_PARM_DESC(nowayout,
  "Watchdog cannot be stopped once started (default="
    __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");

static int soft_noboot;
module_param(soft_noboot, int, 0);
MODULE_PARM_DESC(soft_noboot,
 "Softdog action, set to 1 to ignore reboots, 0 to reboot (default=0)");

static int soft_panic;
module_param(soft_panic, int, 0);
MODULE_PARM_DESC(soft_panic,
 "Softdog action, set to 1 to panic, 0 to reboot (default=0)");

static char *soft_reboot_cmd;
module_param(soft_reboot_cmd, charp, 0000);
MODULE_PARM_DESC(soft_reboot_cmd,
 "Set reboot command. Emergency reboot takes place if unset");

static bool soft_active_on_boot;
module_param(soft_active_on_boot, bool, 0000);
MODULE_PARM_DESC(soft_active_on_boot,
 "Set to true to active Softdog on boot (default=false)");

static struct hrtimer softdog_ticktock;
static struct hrtimer softdog_preticktock;

static int reboot_kthread_fn(void *data)
{
 kernel_restart(soft_reboot_cmd);
 return -EPERM; /* Should not reach here */
}

static void reboot_work_fn(struct work_struct *unused)
{
 kthread_run(reboot_kthread_fn, NULL, "softdog_reboot");
}

static enum hrtimer_restart softdog_fire(struct hrtimer *timer)
{
 static bool soft_reboot_fired;

 module_put(THIS_MODULE);
 if (soft_noboot) {
  pr_crit("Triggered - Reboot ignored\n");
 } else if (soft_panic) {
  pr_crit("Initiating panic\n");
  panic("Software Watchdog Timer expired");
 } else {
  pr_crit("Initiating system reboot\n");
  if (!soft_reboot_fired && soft_reboot_cmd != NULL) {
   static DECLARE_WORK(reboot_work, reboot_work_fn);
   /*
    * The 'kernel_restart' is a 'might-sleep' operation.
    * Also, executing it in system-wide workqueues blocks
    * any driver from using the same workqueue in its
    * shutdown callback function. Thus, we should execute
    * the 'kernel_restart' in a standalone kernel thread.
    * But since starting a kernel thread is also a
    * 'might-sleep' operation, so the 'reboot_work' is
    * required as a launcher of the kernel thread.
    *
    * After request the reboot, restart the timer to
    * schedule an 'emergency_restart' reboot after
    * 'TIMER_MARGIN' seconds. It's because if the softdog
    * hangs, it might be because of scheduling issues. And
    * if that is the case, both 'schedule_work' and
    * 'kernel_restart' may possibly be malfunctional at the
    * same time.
 */
   soft_reboot_fired = true;
   schedule_work(&reboot_work);
   hrtimer_add_expires_ns(timer,
     (u64)TIMER_MARGIN * NSEC_PER_SEC);

   return HRTIMER_RESTART;
  }
  emergency_restart();
  pr_crit("Reboot didn't ?????\n");
 }

 return HRTIMER_NORESTART;
}

static struct watchdog_device softdog_dev;

static enum hrtimer_restart softdog_pretimeout(struct hrtimer *timer)
{
 watchdog_notify_pretimeout(&softdog_dev);

 return HRTIMER_NORESTART;
}

static int softdog_ping(struct watchdog_device *w)
{
 if (!hrtimer_active(&softdog_ticktock))
  __module_get(THIS_MODULE);
 hrtimer_start(&softdog_ticktock, ktime_set(w->timeout, 0),
        HRTIMER_MODE_REL);

 if (IS_ENABLED(CONFIG_SOFT_WATCHDOG_PRETIMEOUT)) {
  if (w->pretimeout)
   hrtimer_start(&softdog_preticktock,
          ktime_set(w->timeout - w->pretimeout, 0),
          HRTIMER_MODE_REL);
  else
   hrtimer_cancel(&softdog_preticktock);
 }

 return 0;
}

static int softdog_stop(struct watchdog_device *w)
{
 if (hrtimer_cancel(&softdog_ticktock))
  module_put(THIS_MODULE);

 if (IS_ENABLED(CONFIG_SOFT_WATCHDOG_PRETIMEOUT))
  hrtimer_cancel(&softdog_preticktock);

 return 0;
}

static struct watchdog_info softdog_info = {
 .identity = "Software Watchdog",
 .options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING | WDIOF_MAGICCLOSE,
};

static const struct watchdog_ops softdog_ops = {
 .owner = THIS_MODULE,
 .start = softdog_ping,
 .stop = softdog_stop,
};

static struct watchdog_device softdog_dev = {
 .info = &softdog_info,
 .ops = &softdog_ops,
 .min_timeout = 1,
 .max_timeout = 65535,
 .timeout = TIMER_MARGIN,
};

static int __init softdog_init(void)
{
 int ret;

 watchdog_init_timeout(&softdog_dev, soft_margin, NULL);
 watchdog_set_nowayout(&softdog_dev, nowayout);
 watchdog_stop_on_reboot(&softdog_dev);

 hrtimer_setup(&softdog_ticktock, softdog_fire, CLOCK_MONOTONIC, HRTIMER_MODE_REL);

 if (IS_ENABLED(CONFIG_SOFT_WATCHDOG_PRETIMEOUT)) {
  softdog_info.options |= WDIOF_PRETIMEOUT;
  hrtimer_setup(&softdog_preticktock, softdog_pretimeout, CLOCK_MONOTONIC,
         HRTIMER_MODE_REL);
 }

 if (soft_active_on_boot)
  softdog_ping(&softdog_dev);

 ret = watchdog_register_device(&softdog_dev);
 if (ret)
  return ret;

 pr_info("initialized. soft_noboot=%d soft_margin=%d sec soft_panic=%d (nowayout=%d)\n",
  soft_noboot, softdog_dev.timeout, soft_panic, nowayout);
 pr_info("             soft_reboot_cmd=%s soft_active_on_boot=%d\n",
  soft_reboot_cmd ?: "<not set>", soft_active_on_boot);

 return 0;
}
module_init(softdog_init);

static void __exit softdog_exit(void)
{
 watchdog_unregister_device(&softdog_dev);
}
module_exit(softdog_exit);

MODULE_AUTHOR("Alan Cox");
MODULE_DESCRIPTION("Software Watchdog Device Driver");
MODULE_LICENSE("GPL");