Home | History | Annotate | Line # | Download | only in pci
weasel_pci.c revision 1.14.22.2
      1  1.14.22.1       tls /*	$NetBSD: weasel_pci.c,v 1.14.22.2 2017/12/03 11:37:29 jdolecek Exp $	*/
      2        1.1   hpeyerl 
      3        1.1   hpeyerl /*-
      4        1.1   hpeyerl  * Copyright (c) 2001 The NetBSD Foundation, Inc.
      5        1.1   hpeyerl  * All rights reserved.
      6        1.1   hpeyerl  *
      7        1.1   hpeyerl  * This code is derived from software contributed to The NetBSD Foundation
      8        1.1   hpeyerl  * by Herb Peyerl and Jason Thorpe.
      9        1.1   hpeyerl  *
     10        1.1   hpeyerl  * Redistribution and use in source and binary forms, with or without
     11        1.1   hpeyerl  * modification, are permitted provided that the following conditions
     12        1.1   hpeyerl  * are met:
     13        1.1   hpeyerl  * 1. Redistributions of source code must retain the above copyright
     14        1.1   hpeyerl  *    notice, this list of conditions and the following disclaimer.
     15        1.1   hpeyerl  * 2. Redistributions in binary form must reproduce the above copyright
     16        1.1   hpeyerl  *    notice, this list of conditions and the following disclaimer in the
     17        1.1   hpeyerl  *    documentation and/or other materials provided with the distribution.
     18        1.1   hpeyerl  *
     19        1.1   hpeyerl  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20        1.1   hpeyerl  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21        1.1   hpeyerl  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22        1.1   hpeyerl  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23        1.1   hpeyerl  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24        1.1   hpeyerl  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25        1.1   hpeyerl  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26        1.1   hpeyerl  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27        1.1   hpeyerl  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28        1.1   hpeyerl  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29        1.1   hpeyerl  * POSSIBILITY OF SUCH DAMAGE.
     30        1.1   hpeyerl  */
     31        1.1   hpeyerl 
     32        1.1   hpeyerl /*
     33        1.1   hpeyerl  * Device driver for the control space on the Middle Digital, Inc.
     34        1.1   hpeyerl  * PCI-Weasel serial console board.
     35        1.1   hpeyerl  *
     36        1.1   hpeyerl  * Since the other functions of the PCI-Weasel already appear in
     37        1.1   hpeyerl  * PCI configuration space, we just need to hook up the watchdog
     38        1.1   hpeyerl  * timer.
     39        1.1   hpeyerl  */
     40        1.1   hpeyerl 
     41        1.1   hpeyerl #include <sys/cdefs.h>
     42  1.14.22.1       tls __KERNEL_RCSID(0, "$NetBSD: weasel_pci.c,v 1.14.22.2 2017/12/03 11:37:29 jdolecek Exp $");
     43        1.1   hpeyerl 
     44        1.1   hpeyerl #include <sys/param.h>
     45        1.1   hpeyerl #include <sys/systm.h>
     46        1.1   hpeyerl #include <sys/device.h>
     47        1.1   hpeyerl #include <sys/wdog.h>
     48        1.1   hpeyerl #include <sys/endian.h>
     49        1.1   hpeyerl 
     50       1.10        ad #include <sys/bus.h>
     51        1.1   hpeyerl 
     52        1.1   hpeyerl #include <dev/pci/pcireg.h>
     53        1.1   hpeyerl #include <dev/pci/pcivar.h>
     54        1.1   hpeyerl #include <dev/pci/pcidevs.h>
     55        1.1   hpeyerl 
     56        1.1   hpeyerl #include <dev/pci/weaselreg.h>
     57        1.1   hpeyerl 
     58        1.1   hpeyerl #include <dev/sysmon/sysmonvar.h>
     59        1.1   hpeyerl 
     60        1.1   hpeyerl struct weasel_softc {
     61       1.13     joerg 	device_t sc_dev;
     62        1.1   hpeyerl 	bus_space_tag_t sc_st;
     63        1.1   hpeyerl 	bus_space_handle_t sc_sh;
     64        1.1   hpeyerl 
     65        1.1   hpeyerl 	struct sysmon_wdog sc_smw;
     66        1.1   hpeyerl 
     67        1.1   hpeyerl 	int sc_wdog_armed;
     68        1.1   hpeyerl 	int sc_wdog_period;
     69        1.1   hpeyerl };
     70        1.1   hpeyerl 
     71        1.6   thorpej /* XXX */
     72        1.1   hpeyerl extern int	sysmon_wdog_setmode(struct sysmon_wdog *, int, u_int);
     73        1.1   hpeyerl 
     74        1.6   thorpej static int	weasel_pci_wdog_setmode(struct sysmon_wdog *);
     75        1.6   thorpej static int	weasel_pci_wdog_tickle(struct sysmon_wdog *);
     76        1.1   hpeyerl 
     77        1.6   thorpej static int	weasel_wait_response(struct weasel_softc *);
     78        1.6   thorpej static int	weasel_issue_command(struct weasel_softc *, uint8_t cmd);
     79        1.1   hpeyerl 
     80        1.6   thorpej static int	weasel_pci_wdog_arm(struct weasel_softc *);
     81        1.6   thorpej static int	weasel_pci_wdog_disarm(struct weasel_softc *);
     82        1.1   hpeyerl 
     83        1.6   thorpej static int	weasel_pci_wdog_query_state(struct weasel_softc *);
     84        1.1   hpeyerl 
     85        1.6   thorpej static int
     86       1.13     joerg weasel_pci_match(device_t parent, cfdata_t cf, void *aux)
     87        1.1   hpeyerl {
     88        1.1   hpeyerl 	struct pci_attach_args *pa = aux;
     89        1.1   hpeyerl 
     90        1.1   hpeyerl 	if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_MIDDLE_DIGITAL &&
     91        1.1   hpeyerl 	    PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_MIDDLE_DIGITAL_WEASEL_CONTROL)
     92        1.1   hpeyerl 		return (1);
     93        1.1   hpeyerl 
     94        1.1   hpeyerl 	return (0);
     95        1.1   hpeyerl }
     96        1.1   hpeyerl 
     97        1.6   thorpej static void
     98       1.13     joerg weasel_pci_attach(device_t parent, device_t self, void *aux)
     99        1.1   hpeyerl {
    100       1.13     joerg 	struct weasel_softc *sc = device_private(self);
    101        1.1   hpeyerl 	struct pci_attach_args *pa = aux;
    102        1.1   hpeyerl 	struct weasel_config_block cfg;
    103        1.1   hpeyerl 	const char *vers, *mode;
    104        1.1   hpeyerl 	uint8_t v, *cp;
    105        1.1   hpeyerl 	uint16_t cfg_size;
    106        1.1   hpeyerl 	uint8_t buf[8];
    107        1.1   hpeyerl 
    108       1.13     joerg 	sc->sc_dev = self;
    109       1.13     joerg 
    110        1.1   hpeyerl 	printf(": PCI-Weasel watchdog timer\n");
    111        1.1   hpeyerl 
    112        1.1   hpeyerl 	if (pci_mapreg_map(pa, PCI_MAPREG_START,
    113        1.1   hpeyerl 	    PCI_MAPREG_TYPE_MEM|PCI_MAPREG_MEM_TYPE_32BIT, 0,
    114        1.1   hpeyerl 	    &sc->sc_st, &sc->sc_sh, NULL, NULL) != 0) {
    115       1.13     joerg 		aprint_error_dev(self, "unable to map device registers\n");
    116        1.1   hpeyerl 		return;
    117        1.1   hpeyerl 	}
    118        1.1   hpeyerl 
    119        1.1   hpeyerl 	/* Ping the Weasel to see if it's alive. */
    120        1.1   hpeyerl 	if (weasel_issue_command(sc, OS_CMD_PING)) {
    121       1.13     joerg 		aprint_error_dev(self, "Weasel didn't respond to PING\n");
    122        1.1   hpeyerl 		return;
    123        1.1   hpeyerl 	}
    124        1.1   hpeyerl 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    125        1.1   hpeyerl 	if ((v = bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_DATA_RD)) !=
    126        1.1   hpeyerl 	    OS_RET_PONG) {
    127  1.14.22.2  jdolecek 		aprint_error_dev(self,
    128  1.14.22.2  jdolecek 		    "unexpected PING response from Weasel: 0x%02x\n", v);
    129        1.1   hpeyerl 		return;
    130        1.1   hpeyerl 	}
    131        1.1   hpeyerl 
    132        1.1   hpeyerl 	/* Read the config block. */
    133        1.1   hpeyerl 	if (weasel_issue_command(sc, OS_CMD_SHOW_CONFIG)) {
    134  1.14.22.2  jdolecek 		aprint_error_dev(self,
    135  1.14.22.2  jdolecek 		    "Weasel didn't respond to SHOW_CONFIG\n");
    136        1.1   hpeyerl 		return;
    137        1.1   hpeyerl 	}
    138        1.1   hpeyerl 	cfg_size = bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_DATA_RD);
    139        1.1   hpeyerl 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    140        1.1   hpeyerl 
    141        1.1   hpeyerl 	if (++cfg_size != sizeof(cfg)) {
    142  1.14.22.2  jdolecek 		aprint_error_dev(self,
    143  1.14.22.2  jdolecek 		    "weird config block size from Weasel: 0x%03x\n", cfg_size);
    144        1.1   hpeyerl 		return;
    145        1.1   hpeyerl 	}
    146        1.1   hpeyerl 
    147        1.1   hpeyerl 	for (cp = (uint8_t *) &cfg; cfg_size != 0; cfg_size--) {
    148        1.1   hpeyerl 		if (weasel_wait_response(sc)) {
    149  1.14.22.2  jdolecek 			aprint_error_dev(self,
    150  1.14.22.2  jdolecek 			    "Weasel stopped providing config block(%d)\n",
    151  1.14.22.2  jdolecek 			    cfg_size);
    152        1.1   hpeyerl 			return;
    153        1.1   hpeyerl 		}
    154        1.1   hpeyerl 		*cp++ = bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_DATA_RD);
    155        1.1   hpeyerl 		bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    156        1.1   hpeyerl 	}
    157        1.1   hpeyerl 
    158        1.1   hpeyerl 	switch (cfg.cfg_version) {
    159        1.1   hpeyerl 	case CFG_VERSION_2:
    160        1.1   hpeyerl 		vers="2";
    161        1.1   hpeyerl 		switch (cfg.enable_duart_switching) {
    162        1.1   hpeyerl 		case 0:
    163        1.1   hpeyerl 			mode = "emulation";
    164        1.1   hpeyerl 			break;
    165        1.1   hpeyerl 		case 1:
    166        1.1   hpeyerl 			mode = "serial";
    167        1.1   hpeyerl 			break;
    168        1.1   hpeyerl 		case 2:
    169        1.1   hpeyerl 			mode = "autoswitch";
    170        1.1   hpeyerl 			break;
    171        1.1   hpeyerl 		default:
    172        1.1   hpeyerl 			mode = "unknown";
    173        1.1   hpeyerl 		}
    174        1.1   hpeyerl 		break;
    175        1.1   hpeyerl 
    176        1.1   hpeyerl 	default:
    177        1.1   hpeyerl 		vers = mode = NULL;
    178        1.1   hpeyerl 	}
    179        1.1   hpeyerl 
    180        1.1   hpeyerl 	if (vers != NULL)
    181       1.13     joerg 		printf("%s: %s mode\n", device_xname(self), mode);
    182        1.1   hpeyerl 	else
    183  1.14.22.2  jdolecek 		printf("%s: unknown config version 0x%02x\n",
    184  1.14.22.2  jdolecek 		    device_xname(self), cfg.cfg_version);
    185        1.5     perry 
    186        1.1   hpeyerl 	/*
    187        1.1   hpeyerl 	 * Fetch sw version.
    188        1.1   hpeyerl 	 */
    189        1.1   hpeyerl 	if (weasel_issue_command(sc, OS_CMD_QUERY_SW_VER)) {
    190  1.14.22.2  jdolecek 		aprint_error_dev(self,
    191  1.14.22.2  jdolecek 		    "didn't reply to software version query.\n");
    192        1.1   hpeyerl 	}
    193        1.1   hpeyerl 	else {
    194        1.1   hpeyerl 		v = bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_DATA_RD);
    195        1.1   hpeyerl 		bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    196        1.1   hpeyerl 		if (v>7)
    197        1.5     perry 			printf("%s: weird length for version string(%d).\n",
    198       1.13     joerg 			    device_xname(self), v);
    199       1.14    cegger 		memset(buf, 0, sizeof(buf));
    200        1.1   hpeyerl 		for (cp = buf; v != 0; v--) {
    201        1.1   hpeyerl 			if (weasel_wait_response(sc)) {
    202        1.1   hpeyerl 				printf("%s: Weasel stopped providing version\n",
    203       1.13     joerg 				    device_xname(self));
    204        1.1   hpeyerl 			}
    205  1.14.22.2  jdolecek 			*cp++ = bus_space_read_1(sc->sc_st, sc->sc_sh,
    206  1.14.22.2  jdolecek 			    WEASEL_DATA_RD);
    207  1.14.22.2  jdolecek 			bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS,
    208  1.14.22.2  jdolecek 			    0);
    209        1.1   hpeyerl 		}
    210       1.13     joerg 		printf("%s: sw: %s", device_xname(self), buf);
    211        1.1   hpeyerl 	}
    212        1.1   hpeyerl 	/*
    213        1.1   hpeyerl 	 * Fetch logic version.
    214        1.1   hpeyerl 	 */
    215        1.1   hpeyerl 	if (weasel_issue_command(sc, OS_CMD_QUERY_L_VER)) {
    216       1.11    cegger 		aprint_normal("\n");
    217  1.14.22.2  jdolecek 		aprint_error_dev(self,
    218  1.14.22.2  jdolecek 		    "didn't reply to logic version query.\n");
    219        1.1   hpeyerl 	}
    220        1.1   hpeyerl 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    221        1.1   hpeyerl 	v = bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_DATA_RD);
    222        1.1   hpeyerl 	printf(" logic: %03d", v);
    223        1.1   hpeyerl 	/*
    224        1.1   hpeyerl 	 * Fetch vga bios version.
    225        1.1   hpeyerl 	 */
    226        1.1   hpeyerl 	if (weasel_issue_command(sc, OS_CMD_QUERY_VB_VER)) {
    227       1.11    cegger 		aprint_normal("\n");
    228  1.14.22.2  jdolecek 		aprint_error_dev(self,
    229  1.14.22.2  jdolecek 		    "didn't reply to vga bios version query.\n");
    230        1.1   hpeyerl 	}
    231        1.1   hpeyerl 	v = bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_DATA_RD);
    232        1.1   hpeyerl 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    233        1.1   hpeyerl 	printf(" vga bios: %d.%d", (v>>4), (v&0x0f));
    234        1.1   hpeyerl 	/*
    235        1.1   hpeyerl 	 * Fetch hw version.
    236        1.1   hpeyerl 	 */
    237        1.1   hpeyerl 	if (weasel_issue_command(sc, OS_CMD_QUERY_HW_VER)) {
    238       1.11    cegger 		aprint_normal("\n");
    239  1.14.22.2  jdolecek 		aprint_error_dev(self,
    240  1.14.22.2  jdolecek 		    "didn't reply to hardware version query.\n");
    241        1.1   hpeyerl 	}
    242        1.1   hpeyerl 	v = bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_DATA_RD);
    243        1.1   hpeyerl 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    244        1.1   hpeyerl 	printf(" hw: %d.%d", (v>>4), (v&0x0f));
    245        1.1   hpeyerl 
    246       1.13     joerg 	printf("\n%s: break passthrough %s", device_xname(self),
    247        1.1   hpeyerl 	    cfg.break_passthru ? "enabled" : "disabled");
    248        1.5     perry 
    249        1.1   hpeyerl 	if ((sc->sc_wdog_armed = weasel_pci_wdog_query_state(sc)) == -1)
    250        1.1   hpeyerl 		sc->sc_wdog_armed = 0;
    251        1.5     perry 
    252        1.1   hpeyerl 	/* Weasel is big-endian */
    253        1.1   hpeyerl 	sc->sc_wdog_period = be16toh(cfg.wdt_msec) / 1000;
    254        1.1   hpeyerl 
    255        1.1   hpeyerl 	printf(", watchdog timer %d sec.\n", sc->sc_wdog_period);
    256        1.1   hpeyerl 	sc->sc_smw.smw_name = "weasel";
    257        1.1   hpeyerl 	sc->sc_smw.smw_cookie = sc;
    258        1.1   hpeyerl 	sc->sc_smw.smw_setmode = weasel_pci_wdog_setmode;
    259        1.1   hpeyerl 	sc->sc_smw.smw_tickle = weasel_pci_wdog_tickle;
    260        1.1   hpeyerl 	sc->sc_smw.smw_period = sc->sc_wdog_period;
    261        1.1   hpeyerl 
    262        1.1   hpeyerl 	if (sysmon_wdog_register(&sc->sc_smw) != 0)
    263       1.13     joerg 		aprint_error_dev(self, "unable to register PC-Weasel watchdog "
    264       1.11    cegger 		    "with sysmon\n");
    265        1.1   hpeyerl }
    266        1.1   hpeyerl 
    267       1.13     joerg CFATTACH_DECL_NEW(weasel_pci, sizeof(struct weasel_softc),
    268        1.6   thorpej     weasel_pci_match, weasel_pci_attach, NULL, NULL);
    269        1.6   thorpej 
    270        1.6   thorpej static int
    271        1.1   hpeyerl weasel_wait_response(struct weasel_softc *sc)
    272        1.1   hpeyerl {
    273        1.1   hpeyerl 	int i;
    274        1.1   hpeyerl 
    275        1.1   hpeyerl 	for (i = 10000; i ; i--) {
    276        1.1   hpeyerl 		delay(100);
    277        1.1   hpeyerl 		if (bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS) ==
    278        1.1   hpeyerl 		    OS_WS_HOST_READ)
    279        1.1   hpeyerl 			return(0);
    280        1.1   hpeyerl 	}
    281        1.1   hpeyerl 	return (1);
    282        1.1   hpeyerl }
    283        1.1   hpeyerl 
    284        1.6   thorpej static int
    285        1.1   hpeyerl weasel_issue_command(struct weasel_softc *sc, uint8_t cmd)
    286        1.1   hpeyerl {
    287        1.1   hpeyerl 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_DATA_WR, cmd);
    288  1.14.22.2  jdolecek 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_HOST_STATUS,
    289  1.14.22.2  jdolecek 	    OS_HS_WEASEL_READ);
    290        1.1   hpeyerl 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    291        1.1   hpeyerl 	return (weasel_wait_response(sc));
    292        1.1   hpeyerl }
    293        1.1   hpeyerl 
    294        1.6   thorpej static int
    295        1.1   hpeyerl weasel_pci_wdog_setmode(struct sysmon_wdog *smw)
    296        1.1   hpeyerl {
    297        1.1   hpeyerl 	struct weasel_softc *sc = smw->smw_cookie;
    298        1.1   hpeyerl 	int error = 0;
    299        1.1   hpeyerl 
    300        1.1   hpeyerl 	if ((smw->smw_mode & WDOG_MODE_MASK) == WDOG_MODE_DISARMED) {
    301        1.1   hpeyerl 		error = weasel_pci_wdog_disarm(sc);
    302        1.1   hpeyerl 	} else {
    303        1.1   hpeyerl 		if (smw->smw_period == WDOG_PERIOD_DEFAULT)
    304        1.1   hpeyerl 			smw->smw_period = sc->sc_wdog_period;
    305        1.1   hpeyerl 		else if (smw->smw_period != sc->sc_wdog_period) {
    306        1.1   hpeyerl 			/* Can't change the period on the Weasel. */
    307        1.1   hpeyerl 			return (EINVAL);
    308        1.1   hpeyerl 		}
    309        1.1   hpeyerl 		error = weasel_pci_wdog_arm(sc);
    310        1.1   hpeyerl 		weasel_pci_wdog_tickle(smw);
    311        1.1   hpeyerl 	}
    312        1.1   hpeyerl 
    313        1.1   hpeyerl 	return (error);
    314        1.1   hpeyerl }
    315        1.1   hpeyerl 
    316        1.6   thorpej static int
    317        1.1   hpeyerl weasel_pci_wdog_tickle(struct sysmon_wdog *smw)
    318        1.1   hpeyerl {
    319        1.5     perry 	struct weasel_softc *sc = smw->smw_cookie;
    320        1.1   hpeyerl 	u_int8_t reg;
    321        1.1   hpeyerl 	int x;
    322        1.1   hpeyerl 	int s;
    323        1.1   hpeyerl 	int error = 0;
    324        1.1   hpeyerl 
    325        1.1   hpeyerl 	s = splhigh();
    326        1.1   hpeyerl 	/*
    327        1.1   hpeyerl 	 * first we tickle the watchdog
    328        1.1   hpeyerl 	 */
    329        1.1   hpeyerl 	reg = bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_CHALLENGE);
    330        1.1   hpeyerl 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_RESPONSE, ~reg);
    331        1.1   hpeyerl 
    332        1.1   hpeyerl 	/*
    333        1.1   hpeyerl 	 * then we check to make sure the weasel is still armed. If someone
    334        1.1   hpeyerl 	 * has rebooted the weasel for whatever reason (firmware update),
    335        1.5     perry 	 * then the watchdog timer would no longer be armed and we'd be
    336        1.1   hpeyerl 	 * servicing nothing. Let the user know that the machine is no
    337        1.1   hpeyerl 	 * longer being monitored by the weasel.
    338        1.1   hpeyerl 	 */
    339        1.1   hpeyerl 	if((x = weasel_pci_wdog_query_state(sc)) == -1)
    340        1.1   hpeyerl 		error = EIO;
    341        1.5     perry 	if (x == 1) {
    342        1.1   hpeyerl 		error = 0;
    343        1.1   hpeyerl 	} else {
    344        1.5     perry 		printf("%s: Watchdog timer disabled on PC/Weasel! Disarming wdog.\n",
    345       1.13     joerg 			device_xname(sc->sc_dev));
    346        1.1   hpeyerl 		sc->sc_wdog_armed = 0;
    347        1.1   hpeyerl 		sysmon_wdog_setmode(smw, WDOG_MODE_DISARMED, 0);
    348        1.1   hpeyerl 		error = 1;
    349        1.1   hpeyerl 	}
    350        1.1   hpeyerl 	splx(s);
    351        1.1   hpeyerl 
    352        1.1   hpeyerl 	return (error);
    353        1.1   hpeyerl }
    354        1.1   hpeyerl 
    355        1.6   thorpej static int
    356        1.1   hpeyerl weasel_pci_wdog_arm(struct weasel_softc *sc)
    357        1.1   hpeyerl {
    358        1.1   hpeyerl 	int x;
    359        1.1   hpeyerl 	int s;
    360        1.1   hpeyerl 	int error = 0;
    361        1.1   hpeyerl 
    362        1.1   hpeyerl 	s = splhigh();
    363        1.1   hpeyerl 	if (weasel_issue_command(sc, OS_CMD_WDT_ENABLE)) {
    364        1.5     perry 		printf("%s: no reply to watchdog enable. Check Weasel \"Allow Watchdog\" setting.\n",
    365       1.13     joerg 			device_xname(sc->sc_dev));
    366        1.1   hpeyerl 		error = EIO;
    367        1.1   hpeyerl 	}
    368  1.14.22.1       tls 	(void)bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_DATA_RD);
    369        1.1   hpeyerl 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    370        1.1   hpeyerl 
    371        1.1   hpeyerl 	/*
    372        1.1   hpeyerl 	 * Ensure that the Weasel thinks it's in the same mode we want it to
    373        1.1   hpeyerl 	 * be in.   EIO if not.
    374        1.1   hpeyerl 	 */
    375        1.1   hpeyerl 	x = weasel_pci_wdog_query_state(sc);
    376        1.1   hpeyerl 	switch (x) {
    377        1.1   hpeyerl 		case -1:
    378        1.1   hpeyerl 			error = EIO;
    379        1.1   hpeyerl 			break;
    380        1.5     perry 		case 0:
    381        1.1   hpeyerl 			sc->sc_wdog_armed = 0;
    382        1.1   hpeyerl 			error = EIO;
    383        1.1   hpeyerl 			break;
    384        1.1   hpeyerl 		case 1:
    385        1.1   hpeyerl 			sc->sc_wdog_armed = 1;
    386        1.1   hpeyerl 			error = 0;
    387        1.1   hpeyerl 			break;
    388        1.1   hpeyerl 	}
    389        1.5     perry 
    390        1.1   hpeyerl 	splx(s);
    391        1.1   hpeyerl 	return(error);
    392        1.1   hpeyerl }
    393        1.1   hpeyerl 
    394        1.1   hpeyerl 
    395        1.6   thorpej static int
    396        1.1   hpeyerl weasel_pci_wdog_disarm(struct weasel_softc *sc)
    397        1.1   hpeyerl {
    398        1.1   hpeyerl 	int x;
    399        1.1   hpeyerl 	int s;
    400        1.1   hpeyerl 	int error = 0;
    401        1.1   hpeyerl 
    402        1.1   hpeyerl 	s = splhigh();
    403        1.1   hpeyerl 
    404        1.1   hpeyerl 	if (weasel_issue_command(sc, OS_CMD_WDT_DISABLE)) {
    405        1.5     perry 		printf("%s: didn't reply to watchdog disable.\n",
    406       1.13     joerg 			device_xname(sc->sc_dev));
    407        1.1   hpeyerl 		error = EIO;
    408        1.1   hpeyerl 	}
    409  1.14.22.1       tls 	(void)bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_DATA_RD);
    410        1.1   hpeyerl 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    411        1.1   hpeyerl 
    412        1.1   hpeyerl 	/*
    413        1.1   hpeyerl 	 * Ensure that the Weasel thinks it's in the same mode we want it to
    414        1.1   hpeyerl 	 * be in.   EIO if not.
    415        1.1   hpeyerl 	 */
    416        1.1   hpeyerl 	x = weasel_pci_wdog_query_state(sc);
    417        1.1   hpeyerl 	switch (x) {
    418        1.1   hpeyerl 		case -1:
    419        1.1   hpeyerl 			error = EIO;
    420        1.1   hpeyerl 			break;
    421        1.5     perry 		case 0:
    422        1.1   hpeyerl 			sc->sc_wdog_armed = 0;
    423        1.1   hpeyerl 			error = 0;
    424        1.1   hpeyerl 			break;
    425        1.1   hpeyerl 		case 1:
    426        1.1   hpeyerl 			sc->sc_wdog_armed = 1;
    427        1.1   hpeyerl 			error = EIO;
    428        1.1   hpeyerl 			break;
    429        1.1   hpeyerl 	}
    430        1.5     perry 
    431        1.1   hpeyerl 	splx(s);
    432        1.1   hpeyerl 	return(error);
    433        1.1   hpeyerl }
    434        1.1   hpeyerl 
    435        1.6   thorpej static int
    436        1.1   hpeyerl weasel_pci_wdog_query_state(struct weasel_softc *sc)
    437        1.1   hpeyerl {
    438        1.1   hpeyerl 
    439        1.1   hpeyerl 	u_int8_t v;
    440        1.1   hpeyerl 
    441        1.1   hpeyerl 	if (weasel_issue_command(sc, OS_CMD_WDT_QUERY)) {
    442        1.5     perry 		printf("%s: didn't reply to watchdog state query.\n",
    443       1.13     joerg 			device_xname(sc->sc_dev));
    444        1.1   hpeyerl 		bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    445        1.1   hpeyerl 		return(-1);
    446        1.1   hpeyerl 	}
    447        1.1   hpeyerl 	v = bus_space_read_1(sc->sc_st, sc->sc_sh, WEASEL_DATA_RD);
    448        1.1   hpeyerl 	bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 0);
    449        1.1   hpeyerl 	return(v);
    450        1.1   hpeyerl }
    451