Home | History | Annotate | Line # | Download | only in sysmon
swwdog.c revision 1.10
      1  1.10  pgoyette /*	$NetBSD: swwdog.c,v 1.10 2010/07/22 14:10:15 pgoyette Exp $	*/
      2   1.1       smb 
      3   1.1       smb /*
      4   1.1       smb  * Copyright (c) 2004, 2005 Steven M. Bellovin
      5   1.1       smb  * All rights reserved.
      6   1.1       smb  *
      7   1.1       smb  * Redistribution and use in source and binary forms, with or without
      8   1.1       smb  * modification, are permitted provided that the following conditions
      9   1.1       smb  * are met:
     10   1.1       smb  * 1. Redistributions of source code must retain the above copyright
     11   1.1       smb  *    notice, this list of conditions and the following disclaimer.
     12   1.1       smb  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1       smb  *    notice, this list of conditions and the following disclaimer in the
     14   1.1       smb  *    documentation and/or other materials provided with the distribution.
     15   1.1       smb  * 3. All advertising materials mentioning features or use of this software
     16   1.1       smb  *    must display the following acknowledgement:
     17   1.1       smb  *      This product includes software developed by Steven M. Bellovin
     18   1.1       smb  * 4. The name of the author contributors may not be used to endorse or
     19   1.1       smb  *    promote products derived from this software without specific prior
     20   1.1       smb  *    written permission.
     21   1.1       smb  *
     22   1.1       smb  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS
     23   1.1       smb  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     24   1.1       smb  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     25   1.1       smb  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS
     26   1.1       smb  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     27   1.1       smb  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     28   1.1       smb  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     29   1.1       smb  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     30   1.1       smb  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     31   1.1       smb  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     32   1.1       smb  * POSSIBILITY OF SUCH DAMAGE.
     33   1.1       smb  */
     34   1.1       smb 
     35   1.1       smb #include <sys/cdefs.h>
     36  1.10  pgoyette __KERNEL_RCSID(0, "$NetBSD: swwdog.c,v 1.10 2010/07/22 14:10:15 pgoyette Exp $");
     37   1.1       smb 
     38   1.1       smb /*
     39   1.1       smb  *
     40   1.1       smb  * Software watchdog timer
     41   1.1       smb  *
     42   1.1       smb  */
     43   1.1       smb #include <sys/param.h>
     44   1.2     perry #include <sys/callout.h>
     45   1.2     perry #include <sys/device.h>
     46   1.2     perry #include <sys/kernel.h>
     47  1.10  pgoyette #include <sys/kmem.h>
     48   1.1       smb #include <sys/reboot.h>
     49   1.1       smb #include <sys/systm.h>
     50  1.10  pgoyette #include <sys/sysctl.h>
     51   1.1       smb #include <sys/wdog.h>
     52   1.1       smb #include <dev/sysmon/sysmonvar.h>
     53   1.1       smb 
     54  1.10  pgoyette #include "ioconf.h"
     55  1.10  pgoyette 
     56   1.1       smb struct swwdog_softc {
     57  1.10  pgoyette 	device_t sc_dev;
     58   1.1       smb 	struct sysmon_wdog sc_smw;
     59   1.1       smb 	struct callout sc_c;
     60   1.1       smb 	int sc_wdog_armed;
     61  1.10  pgoyette };
     62  1.10  pgoyette 
     63  1.10  pgoyette void		swwdogattach(int);
     64   1.1       smb 
     65  1.10  pgoyette static int	swwdog_match(device_t, cfdata_t, void *);
     66  1.10  pgoyette static void	swwdog_attach(device_t, device_t, void *);
     67  1.10  pgoyette static int	swwdog_detach(device_t, int);
     68  1.10  pgoyette static bool	swwdog_suspend(device_t, const pmf_qual_t *);
     69   1.1       smb 
     70   1.1       smb static int swwdog_setmode(struct sysmon_wdog *);
     71   1.1       smb static int swwdog_tickle(struct sysmon_wdog *);
     72   1.1       smb 
     73   1.1       smb static int swwdog_arm(struct swwdog_softc *);
     74   1.1       smb static int swwdog_disarm(struct swwdog_softc *);
     75   1.1       smb 
     76   1.1       smb static void swwdog_panic(void *);
     77   1.1       smb 
     78  1.10  pgoyette bool swwdog_reboot = false;		/* set for panic instead of reboot */
     79   1.1       smb 
     80   1.1       smb #define	SWDOG_DEFAULT	60		/* 60-second default period */
     81   1.1       smb 
     82  1.10  pgoyette CFATTACH_DECL_NEW(swwdog, sizeof(struct swwdog_softc),
     83  1.10  pgoyette 	swwdog_match, swwdog_attach, swwdog_detach, NULL);
     84  1.10  pgoyette 
     85   1.1       smb void
     86  1.10  pgoyette swwdogattach(int n __unused)
     87   1.1       smb {
     88  1.10  pgoyette 	int err;
     89  1.10  pgoyette 	static struct cfdata cf;
     90  1.10  pgoyette 
     91  1.10  pgoyette 	err = config_cfattach_attach(swwdog_cd.cd_name, &swwdog_ca);
     92  1.10  pgoyette 	if (err) {
     93  1.10  pgoyette 		aprint_error("%s: couldn't register cfattach: %d\n",
     94  1.10  pgoyette 		    swwdog_cd.cd_name, err);
     95  1.10  pgoyette 		config_cfdriver_detach(&swwdog_cd);
     96  1.10  pgoyette 		return;
     97  1.10  pgoyette 	}
     98   1.1       smb 
     99  1.10  pgoyette 	cf.cf_name = swwdog_cd.cd_name;
    100  1.10  pgoyette 	cf.cf_atname = swwdog_cd.cd_name;
    101  1.10  pgoyette 	cf.cf_unit = 0;
    102  1.10  pgoyette 	cf.cf_fstate = FSTATE_STAR;
    103   1.1       smb 
    104  1.10  pgoyette 	(void)config_attach_pseudo(&cf);
    105  1.10  pgoyette 
    106  1.10  pgoyette 	return;
    107  1.10  pgoyette }
    108  1.10  pgoyette 
    109  1.10  pgoyette static int
    110  1.10  pgoyette swwdog_match(device_t parent, cfdata_t data, void *aux)
    111  1.10  pgoyette {
    112  1.10  pgoyette 	return 1;
    113  1.10  pgoyette }
    114  1.10  pgoyette 
    115  1.10  pgoyette static void
    116  1.10  pgoyette swwdog_attach(device_t parent, device_t self, void *aux)
    117  1.10  pgoyette {
    118  1.10  pgoyette 	struct swwdog_softc *sc = device_private(self);
    119  1.10  pgoyette 
    120  1.10  pgoyette 	sc->sc_dev = self;
    121  1.10  pgoyette 	sc->sc_smw.smw_name = device_xname(self);
    122  1.10  pgoyette 	sc->sc_smw.smw_cookie = sc;
    123  1.10  pgoyette 	sc->sc_smw.smw_setmode = swwdog_setmode;
    124  1.10  pgoyette 	sc->sc_smw.smw_tickle = swwdog_tickle;
    125  1.10  pgoyette 	sc->sc_smw.smw_period = SWDOG_DEFAULT;
    126  1.10  pgoyette 	callout_init(&sc->sc_c, 0);
    127  1.10  pgoyette 	callout_setfunc(&sc->sc_c, swwdog_panic, sc);
    128  1.10  pgoyette 
    129  1.10  pgoyette 	if (sysmon_wdog_register(&sc->sc_smw) == 0)
    130  1.10  pgoyette 		aprint_normal_dev(self, "software watchdog initialized\n");
    131  1.10  pgoyette 	else
    132  1.10  pgoyette 		aprint_error_dev(self, "unable to register software "
    133  1.10  pgoyette 		    "watchdog with sysmon\n");
    134   1.1       smb 
    135  1.10  pgoyette 	if (!pmf_device_register(self, swwdog_suspend, NULL))
    136  1.10  pgoyette 		aprint_error_dev(self, "couldn't establish power handler\n");
    137  1.10  pgoyette }
    138  1.10  pgoyette 
    139  1.10  pgoyette static int
    140  1.10  pgoyette swwdog_detach(device_t self, int flags)
    141  1.10  pgoyette {
    142  1.10  pgoyette 	struct swwdog_softc *sc = device_private(self);
    143  1.10  pgoyette 
    144  1.10  pgoyette 	swwdog_disarm(sc);
    145  1.10  pgoyette 	callout_destroy(&sc->sc_c);
    146  1.10  pgoyette 
    147  1.10  pgoyette 	return 1;
    148  1.10  pgoyette }
    149  1.10  pgoyette 
    150  1.10  pgoyette static bool
    151  1.10  pgoyette swwdog_suspend(device_t dev, const pmf_qual_t *qual)
    152  1.10  pgoyette {
    153  1.10  pgoyette 	struct swwdog_softc *sc = device_private(dev);
    154  1.10  pgoyette 
    155  1.10  pgoyette 	/* Don't allow suspend if watchdog is armed */
    156  1.10  pgoyette 	if ((sc->sc_smw.smw_mode & WDOG_MODE_MASK) != WDOG_MODE_DISARMED)
    157  1.10  pgoyette 		return false;
    158  1.10  pgoyette 	return true;
    159   1.1       smb }
    160   1.1       smb 
    161   1.1       smb static int
    162   1.1       smb swwdog_setmode(struct sysmon_wdog *smw)
    163   1.1       smb {
    164   1.2     perry 	struct swwdog_softc *sc = smw->smw_cookie;
    165   1.1       smb 	int error = 0;
    166   1.1       smb 
    167   1.1       smb 	if ((smw->smw_mode & WDOG_MODE_MASK) == WDOG_MODE_DISARMED) {
    168   1.1       smb 		error = swwdog_disarm(sc);
    169   1.1       smb 	} else {
    170   1.1       smb 		if (smw->smw_period == 0)
    171   1.1       smb 			return EINVAL;
    172   1.1       smb 		else if (smw->smw_period == WDOG_PERIOD_DEFAULT)
    173   1.1       smb 			sc->sc_smw.smw_period = SWDOG_DEFAULT;
    174   1.3    simonb 		else
    175   1.3    simonb 			sc->sc_smw.smw_period = smw->smw_period;
    176   1.1       smb 		error = swwdog_arm(sc);
    177   1.1       smb 	}
    178   1.1       smb 	return error;
    179   1.1       smb }
    180   1.1       smb 
    181   1.1       smb static int
    182   1.1       smb swwdog_tickle(struct sysmon_wdog *smw)
    183   1.1       smb {
    184   1.1       smb 
    185   1.1       smb 	return swwdog_arm(smw->smw_cookie);
    186   1.1       smb }
    187   1.1       smb 
    188   1.1       smb static int
    189   1.1       smb swwdog_arm(struct swwdog_softc *sc)
    190   1.1       smb {
    191   1.1       smb 
    192   1.1       smb 	callout_schedule(&sc->sc_c, sc->sc_smw.smw_period * hz);
    193   1.1       smb 	return 0;
    194   1.1       smb }
    195   1.1       smb 
    196   1.1       smb static int
    197   1.1       smb swwdog_disarm(struct swwdog_softc *sc)
    198   1.1       smb {
    199   1.1       smb 
    200   1.1       smb 	callout_stop(&sc->sc_c);
    201   1.1       smb 	return 0;
    202   1.1       smb }
    203   1.1       smb 
    204   1.1       smb static void
    205   1.2     perry swwdog_panic(void *vsc)
    206   1.1       smb {
    207   1.1       smb 	struct swwdog_softc *sc = vsc;
    208  1.10  pgoyette 	bool do_panic;
    209   1.1       smb 
    210   1.1       smb 	do_panic = swwdog_reboot;
    211   1.1       smb 	swwdog_reboot = 1;
    212   1.1       smb 	callout_schedule(&sc->sc_c, 60 * hz);	/* deliberate double-panic */
    213   1.1       smb 
    214  1.10  pgoyette 	printf("%s: %d second timer expired\n", device_xname(sc->sc_dev),
    215   1.1       smb 	    sc->sc_smw.smw_period);
    216   1.1       smb 
    217   1.1       smb 	if (do_panic)
    218   1.1       smb 		panic("watchdog timer expired");
    219   1.3    simonb 	else
    220   1.3    simonb 		cpu_reboot(0, NULL);
    221   1.1       smb }
    222  1.10  pgoyette 
    223  1.10  pgoyette SYSCTL_SETUP(sysctl_swwdog, "swwdog subtree setup")
    224  1.10  pgoyette {
    225  1.10  pgoyette 	int err;
    226  1.10  pgoyette 	const struct sysctlnode *me;
    227  1.10  pgoyette 
    228  1.10  pgoyette 	err = sysctl_createv(NULL, 0, NULL, NULL, CTLFLAG_PERMANENT,
    229  1.10  pgoyette 	    CTLTYPE_NODE, "machdep", NULL,
    230  1.10  pgoyette 	    NULL, 0, NULL, 0,
    231  1.10  pgoyette 	    CTL_HW, CTL_EOL);
    232  1.10  pgoyette 
    233  1.10  pgoyette 	if (err == 0)
    234  1.10  pgoyette 		err = sysctl_createv(NULL, 0, NULL, &me, CTLFLAG_READWRITE,
    235  1.10  pgoyette 		    CTLTYPE_NODE, "swwdog", NULL,
    236  1.10  pgoyette 		    NULL, 0, NULL, 0,
    237  1.10  pgoyette 		    CTL_HW, CTL_CREATE, CTL_EOL);
    238  1.10  pgoyette 
    239  1.10  pgoyette 	if (err == 0)
    240  1.10  pgoyette 		err = sysctl_createv(NULL, 0, NULL, NULL, CTLFLAG_READWRITE,
    241  1.10  pgoyette 		    CTLTYPE_BOOL, "reboot", "reboot if timer expires",
    242  1.10  pgoyette 		    NULL, 0, &swwdog_reboot, sizeof(bool),
    243  1.10  pgoyette 		    CTL_HW, me->sysctl_num, CTL_CREATE, CTL_EOL);
    244  1.10  pgoyette }
    245