1 1.16 msaitoh /* $NetBSD: weasel_pci.c,v 1.16 2016/07/07 06:55:41 msaitoh 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.16 msaitoh __KERNEL_RCSID(0, "$NetBSD: weasel_pci.c,v 1.16 2016/07/07 06:55:41 msaitoh 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.16 msaitoh aprint_error_dev(self, 128 1.16 msaitoh "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.16 msaitoh aprint_error_dev(self, 135 1.16 msaitoh "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.16 msaitoh aprint_error_dev(self, 143 1.16 msaitoh "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.16 msaitoh aprint_error_dev(self, 150 1.16 msaitoh "Weasel stopped providing config block(%d)\n", 151 1.16 msaitoh 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.16 msaitoh printf("%s: unknown config version 0x%02x\n", 184 1.16 msaitoh 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.16 msaitoh aprint_error_dev(self, 191 1.16 msaitoh "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.16 msaitoh *cp++ = bus_space_read_1(sc->sc_st, sc->sc_sh, 206 1.16 msaitoh WEASEL_DATA_RD); 207 1.16 msaitoh bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_STATUS, 208 1.16 msaitoh 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.16 msaitoh aprint_error_dev(self, 218 1.16 msaitoh "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.16 msaitoh aprint_error_dev(self, 229 1.16 msaitoh "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.16 msaitoh aprint_error_dev(self, 240 1.16 msaitoh "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.16 msaitoh bus_space_write_1(sc->sc_st, sc->sc_sh, WEASEL_HOST_STATUS, 289 1.16 msaitoh 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.15 christos (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.15 christos (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