Home | History | Annotate | Line # | Download | only in dev
wdog.c revision 1.11
      1  1.11     matt /* $NetBSD: wdog.c,v 1.11 2011/06/17 19:03:02 matt Exp $ */
      2   1.1   simonb 
      3   1.1   simonb /*
      4   1.1   simonb  * Copyright (c) 2002 Wasabi Systems, Inc.
      5   1.1   simonb  * All rights reserved.
      6   1.1   simonb  *
      7   1.1   simonb  * Written by Jason R. Thorpe and Simon Burge for Wasabi Systems, Inc.
      8   1.1   simonb  *
      9   1.1   simonb  * Redistribution and use in source and binary forms, with or without
     10   1.1   simonb  * modification, are permitted provided that the following conditions
     11   1.1   simonb  * are met:
     12   1.1   simonb  * 1. Redistributions of source code must retain the above copyright
     13   1.1   simonb  *    notice, this list of conditions and the following disclaimer.
     14   1.1   simonb  * 2. Redistributions in binary form must reproduce the above copyright
     15   1.1   simonb  *    notice, this list of conditions and the following disclaimer in the
     16   1.1   simonb  *    documentation and/or other materials provided with the distribution.
     17   1.1   simonb  * 3. All advertising materials mentioning features or use of this software
     18   1.1   simonb  *    must display the following acknowledgement:
     19   1.1   simonb  *	This product includes software developed for the NetBSD Project by
     20   1.1   simonb  *	Wasabi Systems, Inc.
     21   1.1   simonb  * 4. The name of Wasabi Systems, Inc. may not be used to endorse
     22   1.1   simonb  *    or promote products derived from this software without specific prior
     23   1.1   simonb  *    written permission.
     24   1.1   simonb  *
     25   1.1   simonb  * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
     26   1.1   simonb  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     27   1.1   simonb  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     28   1.1   simonb  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL WASABI SYSTEMS, INC
     29   1.1   simonb  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     30   1.1   simonb  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     31   1.1   simonb  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     32   1.1   simonb  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     33   1.1   simonb  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     34   1.1   simonb  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     35   1.1   simonb  * POSSIBILITY OF SUCH DAMAGE.
     36   1.1   simonb  */
     37   1.1   simonb 
     38   1.1   simonb /*
     39   1.1   simonb  * Watchdog timer support for the IBM 405GP processor.
     40   1.1   simonb  */
     41   1.7    lukem 
     42   1.7    lukem #include <sys/cdefs.h>
     43  1.11     matt __KERNEL_RCSID(0, "$NetBSD: wdog.c,v 1.11 2011/06/17 19:03:02 matt Exp $");
     44   1.1   simonb 
     45   1.1   simonb #include <sys/param.h>
     46   1.1   simonb #include <sys/systm.h>
     47   1.1   simonb #include <sys/device.h>
     48   1.1   simonb #include <sys/wdog.h>
     49   1.1   simonb 
     50   1.9  thorpej #include <prop/proplib.h>
     51   1.9  thorpej 
     52   1.1   simonb #include <powerpc/spr.h>
     53  1.10     matt #include <powerpc/ibm4xx/spr.h>
     54   1.2   simonb #include <powerpc/ibm4xx/dev/opbvar.h>
     55   1.1   simonb 
     56   1.1   simonb #include <dev/sysmon/sysmonvar.h>
     57   1.1   simonb 
     58  1.11     matt static int wdog_match(device_t, cfdata_t, void *);
     59  1.11     matt static void wdog_attach(device_t, device_t, void *);
     60   1.1   simonb static int wdog_tickle(struct sysmon_wdog *);
     61   1.1   simonb static int wdog_setmode(struct sysmon_wdog *);
     62   1.1   simonb 
     63   1.1   simonb struct wdog_softc {
     64  1.11     matt 	device_t sc_dev;
     65   1.1   simonb 	struct sysmon_wdog sc_smw;
     66  1.11     matt 	bool sc_wdog_armed;
     67   1.1   simonb 	int sc_wdog_period;
     68   1.1   simonb };
     69   1.1   simonb 
     70  1.11     matt CFATTACH_DECL_NEW(wdog, sizeof(struct wdog_softc),
     71   1.6  thorpej     wdog_match, wdog_attach, NULL, NULL);
     72   1.1   simonb 
     73   1.1   simonb static int
     74  1.11     matt wdog_match(device_t parent, cfdata_t cf, void *aux)
     75   1.1   simonb {
     76  1.11     matt 	struct opb_attach_args * const oaa = aux;
     77   1.1   simonb 
     78   1.1   simonb 	/* match only watchdog devices */
     79   1.3  thorpej 	if (strcmp(oaa->opb_name, cf->cf_name) != 0)
     80   1.1   simonb 		return (0);
     81   1.1   simonb 
     82   1.1   simonb 	return (1);
     83   1.1   simonb }
     84   1.1   simonb 
     85   1.1   simonb static void
     86  1.11     matt wdog_attach(device_t parent, device_t self, void *aux)
     87   1.1   simonb {
     88  1.11     matt 	struct wdog_softc * const sc = device_private(self);
     89   1.1   simonb 	unsigned int processor_freq;
     90   1.9  thorpej 	prop_number_t freq;
     91   1.1   simonb 
     92   1.9  thorpej 	freq = prop_dictionary_get(board_properties, "processor-frequency");
     93   1.9  thorpej 	KASSERT(freq != NULL);
     94   1.9  thorpej 	processor_freq = (unsigned int) prop_number_integer_value(freq);
     95   1.1   simonb 
     96   1.1   simonb 	sc->sc_wdog_period = (2LL << 29) / processor_freq;
     97   1.1   simonb 	printf(": %d second period\n", sc->sc_wdog_period);
     98   1.1   simonb 
     99  1.11     matt 	sc->sc_dev = self;
    100  1.11     matt 	sc->sc_smw.smw_name = device_xname(self);
    101   1.1   simonb 	sc->sc_smw.smw_cookie = sc;
    102   1.1   simonb 	sc->sc_smw.smw_setmode = wdog_setmode;
    103   1.1   simonb 	sc->sc_smw.smw_tickle = wdog_tickle;
    104   1.1   simonb 	sc->sc_smw.smw_period = sc->sc_wdog_period;
    105   1.1   simonb 
    106   1.1   simonb 	if (sysmon_wdog_register(&sc->sc_smw) != 0)
    107  1.11     matt 		aprint_error_dev(self, "unable to register with sysmon\n");
    108   1.1   simonb }
    109   1.1   simonb 
    110   1.1   simonb static int
    111   1.1   simonb wdog_tickle(struct sysmon_wdog *smw)
    112   1.1   simonb {
    113   1.1   simonb 	uint32_t tsr;
    114   1.1   simonb 
    115   1.1   simonb 	tsr = mfspr(SPR_TSR);
    116   1.1   simonb 	tsr |= TSR_ENW | TSR_WIS;
    117   1.1   simonb 	mtspr(SPR_TSR, tsr);
    118   1.1   simonb 	return (0);
    119   1.1   simonb }
    120   1.1   simonb 
    121   1.1   simonb static int
    122   1.1   simonb wdog_setmode(struct sysmon_wdog *smw)
    123   1.1   simonb {
    124  1.11     matt 	struct wdog_softc * const sc = smw->smw_cookie;
    125   1.1   simonb 
    126   1.1   simonb 	if ((smw->smw_mode & WDOG_MODE_MASK) == WDOG_MODE_DISARMED) {
    127   1.1   simonb 		if (sc->sc_wdog_armed) {
    128  1.11     matt 			uint32_t tsr = mfspr(SPR_TSR);
    129   1.1   simonb 			tsr &= ~(TSR_ENW | TSR_WIS);
    130   1.1   simonb 			mtspr(SPR_TSR, tsr);
    131  1.11     matt 			sc->sc_wdog_armed = false;
    132   1.1   simonb 		}
    133   1.1   simonb 	} else {
    134   1.1   simonb 		if (smw->smw_period == WDOG_PERIOD_DEFAULT)
    135   1.1   simonb 			smw->smw_period = sc->sc_wdog_period;
    136   1.1   simonb 		else if (smw->smw_period != sc->sc_wdog_period) {
    137   1.1   simonb 			/*
    138   1.1   simonb 			 * There's 4 set watchdog periods on the 405GP,
    139   1.1   simonb 			 * but we only support the longest one (2.684
    140   1.1   simonb 			 * seconds).
    141   1.1   simonb 			 */
    142   1.1   simonb 			return (EOPNOTSUPP);
    143   1.1   simonb 		}
    144  1.11     matt 		sc->sc_wdog_armed = true;
    145   1.1   simonb 
    146  1.11     matt 		uint32_t tcr = mfspr(SPR_TCR);
    147   1.1   simonb 		tcr |= TCR_WP_2_29 | TCR_WRC_SYSTEM;
    148   1.1   simonb 		mtspr(SPR_TCR, tcr);
    149   1.1   simonb 
    150   1.1   simonb 		/* Arm the watchdog. */
    151   1.1   simonb 		wdog_tickle(smw);
    152   1.1   simonb 	}
    153   1.1   simonb 	return (0);
    154   1.1   simonb }
    155