hil.c revision 1.2.2.2
1 1.2.2.2 rmind /* $NetBSD: hil.c,v 1.2.2.2 2011/03/05 20:53:09 rmind Exp $ */ 2 1.2.2.2 rmind /* $OpenBSD: hil.c,v 1.24 2010/11/20 16:45:46 miod Exp $ */ 3 1.2.2.2 rmind /* 4 1.2.2.2 rmind * Copyright (c) 2003, 2004, Miodrag Vallat. 5 1.2.2.2 rmind * All rights reserved. 6 1.2.2.2 rmind * 7 1.2.2.2 rmind * Redistribution and use in source and binary forms, with or without 8 1.2.2.2 rmind * modification, are permitted provided that the following conditions 9 1.2.2.2 rmind * are met: 10 1.2.2.2 rmind * 1. Redistributions of source code must retain the above copyright 11 1.2.2.2 rmind * notice, this list of conditions and the following disclaimer. 12 1.2.2.2 rmind * 2. Redistributions in binary form must reproduce the above copyright 13 1.2.2.2 rmind * notice, this list of conditions and the following disclaimer in the 14 1.2.2.2 rmind * documentation and/or other materials provided with the distribution. 15 1.2.2.2 rmind * 16 1.2.2.2 rmind * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.2.2.2 rmind * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 18 1.2.2.2 rmind * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 19 1.2.2.2 rmind * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 20 1.2.2.2 rmind * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 21 1.2.2.2 rmind * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 22 1.2.2.2 rmind * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 1.2.2.2 rmind * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 24 1.2.2.2 rmind * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 25 1.2.2.2 rmind * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 1.2.2.2 rmind * POSSIBILITY OF SUCH DAMAGE. 27 1.2.2.2 rmind * 28 1.2.2.2 rmind */ 29 1.2.2.2 rmind 30 1.2.2.2 rmind /* 31 1.2.2.2 rmind * Copyright (c) 1988 University of Utah. 32 1.2.2.2 rmind * Copyright (c) 1990, 1993 33 1.2.2.2 rmind * The Regents of the University of California. All rights reserved. 34 1.2.2.2 rmind * 35 1.2.2.2 rmind * This code is derived from software contributed to Berkeley by 36 1.2.2.2 rmind * the Systems Programming Group of the University of Utah Computer 37 1.2.2.2 rmind * Science Department. 38 1.2.2.2 rmind * 39 1.2.2.2 rmind * Redistribution and use in source and binary forms, with or without 40 1.2.2.2 rmind * modification, are permitted provided that the following conditions 41 1.2.2.2 rmind * are met: 42 1.2.2.2 rmind * 1. Redistributions of source code must retain the above copyright 43 1.2.2.2 rmind * notice, this list of conditions and the following disclaimer. 44 1.2.2.2 rmind * 2. Redistributions in binary form must reproduce the above copyright 45 1.2.2.2 rmind * notice, this list of conditions and the following disclaimer in the 46 1.2.2.2 rmind * documentation and/or other materials provided with the distribution. 47 1.2.2.2 rmind * 3. Neither the name of the University nor the names of its contributors 48 1.2.2.2 rmind * may be used to endorse or promote products derived from this software 49 1.2.2.2 rmind * without specific prior written permission. 50 1.2.2.2 rmind * 51 1.2.2.2 rmind * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 52 1.2.2.2 rmind * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 53 1.2.2.2 rmind * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 54 1.2.2.2 rmind * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 55 1.2.2.2 rmind * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 56 1.2.2.2 rmind * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 57 1.2.2.2 rmind * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 58 1.2.2.2 rmind * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 59 1.2.2.2 rmind * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 60 1.2.2.2 rmind * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 61 1.2.2.2 rmind * SUCH DAMAGE. 62 1.2.2.2 rmind * 63 1.2.2.2 rmind * from: Utah $Hdr: hil.c 1.38 92/01/21$ 64 1.2.2.2 rmind * 65 1.2.2.2 rmind * @(#)hil.c 8.2 (Berkeley) 1/12/94 66 1.2.2.2 rmind */ 67 1.2.2.2 rmind 68 1.2.2.2 rmind #include <sys/param.h> 69 1.2.2.2 rmind #include <sys/systm.h> 70 1.2.2.2 rmind #include <sys/conf.h> 71 1.2.2.2 rmind #include <sys/device.h> 72 1.2.2.2 rmind #include <sys/file.h> 73 1.2.2.2 rmind #include <sys/ioctl.h> 74 1.2.2.2 rmind #include <sys/kernel.h> 75 1.2.2.2 rmind #include <sys/proc.h> 76 1.2.2.2 rmind #include <sys/kthread.h> 77 1.2.2.2 rmind #include <sys/bus.h> 78 1.2.2.2 rmind #include <sys/cpu.h> 79 1.2.2.2 rmind 80 1.2.2.2 rmind #include <machine/autoconf.h> 81 1.2.2.2 rmind 82 1.2.2.2 rmind #include <dev/hil/hilreg.h> 83 1.2.2.2 rmind #include <dev/hil/hilvar.h> 84 1.2.2.2 rmind #include <dev/hil/hildevs.h> 85 1.2.2.2 rmind #include <dev/hil/hildevs_data.h> 86 1.2.2.2 rmind 87 1.2.2.2 rmind #include "hilkbd.h" 88 1.2.2.2 rmind 89 1.2.2.2 rmind static void hilconfig(struct hil_softc *, u_int); 90 1.2.2.2 rmind static void hilempty(struct hil_softc *); 91 1.2.2.2 rmind static int hilsubmatch(device_t, cfdata_t, const int *, void *); 92 1.2.2.2 rmind static void hil_process_int(struct hil_softc *, uint8_t, uint8_t); 93 1.2.2.2 rmind static int hil_process_poll(struct hil_softc *, uint8_t, uint8_t); 94 1.2.2.2 rmind static void hil_thread(void *); 95 1.2.2.2 rmind static int send_device_cmd(struct hil_softc *sc, u_int device, u_int cmd); 96 1.2.2.2 rmind static void polloff(struct hil_softc *); 97 1.2.2.2 rmind static void pollon(struct hil_softc *); 98 1.2.2.2 rmind 99 1.2.2.2 rmind static int hilwait(struct hil_softc *); 100 1.2.2.2 rmind static int hildatawait(struct hil_softc *); 101 1.2.2.2 rmind 102 1.2.2.2 rmind #define hil_process_pending(sc) wakeup(&(sc)->sc_pending) 103 1.2.2.2 rmind 104 1.2.2.2 rmind static __inline int 105 1.2.2.2 rmind hilwait(struct hil_softc *sc) 106 1.2.2.2 rmind { 107 1.2.2.2 rmind int cnt; 108 1.2.2.2 rmind 109 1.2.2.2 rmind for (cnt = 50000; cnt != 0; cnt--) { 110 1.2.2.2 rmind DELAY(1); 111 1.2.2.2 rmind if ((bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_STAT) & 112 1.2.2.2 rmind HIL_BUSY) == 0) 113 1.2.2.2 rmind break; 114 1.2.2.2 rmind } 115 1.2.2.2 rmind 116 1.2.2.2 rmind return cnt; 117 1.2.2.2 rmind } 118 1.2.2.2 rmind 119 1.2.2.2 rmind static __inline int 120 1.2.2.2 rmind hildatawait(struct hil_softc *sc) 121 1.2.2.2 rmind { 122 1.2.2.2 rmind int cnt; 123 1.2.2.2 rmind 124 1.2.2.2 rmind for (cnt = 50000; cnt != 0; cnt--) { 125 1.2.2.2 rmind DELAY(1); 126 1.2.2.2 rmind if ((bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_STAT) & 127 1.2.2.2 rmind HIL_DATA_RDY) != 0) 128 1.2.2.2 rmind break; 129 1.2.2.2 rmind } 130 1.2.2.2 rmind 131 1.2.2.2 rmind return cnt; 132 1.2.2.2 rmind } 133 1.2.2.2 rmind 134 1.2.2.2 rmind /* 135 1.2.2.2 rmind * Common HIL bus attachment 136 1.2.2.2 rmind */ 137 1.2.2.2 rmind 138 1.2.2.2 rmind void 139 1.2.2.2 rmind hil_attach(struct hil_softc *sc, int *hil_is_console) 140 1.2.2.2 rmind { 141 1.2.2.2 rmind 142 1.2.2.2 rmind aprint_normal("\n"); 143 1.2.2.2 rmind 144 1.2.2.2 rmind /* 145 1.2.2.2 rmind * Initialize loop information 146 1.2.2.2 rmind */ 147 1.2.2.2 rmind sc->sc_cmdending = 0; 148 1.2.2.2 rmind sc->sc_actdev = sc->sc_cmddev = 0; 149 1.2.2.2 rmind sc->sc_cmddone = 0; 150 1.2.2.2 rmind sc->sc_cmdbp = sc->sc_cmdbuf; 151 1.2.2.2 rmind sc->sc_pollbp = sc->sc_pollbuf; 152 1.2.2.2 rmind sc->sc_console = hil_is_console; 153 1.2.2.2 rmind } 154 1.2.2.2 rmind 155 1.2.2.2 rmind /* 156 1.2.2.2 rmind * HIL subdevice attachment 157 1.2.2.2 rmind */ 158 1.2.2.2 rmind 159 1.2.2.2 rmind int 160 1.2.2.2 rmind hildevprint(void *aux, const char *pnp) 161 1.2.2.2 rmind { 162 1.2.2.2 rmind struct hil_attach_args *ha = aux; 163 1.2.2.2 rmind 164 1.2.2.2 rmind if (pnp != NULL) { 165 1.2.2.2 rmind aprint_normal("\"%s\" at %s id %x", 166 1.2.2.2 rmind ha->ha_descr, pnp, ha->ha_id); 167 1.2.2.2 rmind } 168 1.2.2.2 rmind aprint_normal(" code %d", ha->ha_code); 169 1.2.2.2 rmind if (pnp == NULL) { 170 1.2.2.2 rmind aprint_normal(": %s", ha->ha_descr); 171 1.2.2.2 rmind } 172 1.2.2.2 rmind 173 1.2.2.2 rmind return UNCONF; 174 1.2.2.2 rmind } 175 1.2.2.2 rmind 176 1.2.2.2 rmind int 177 1.2.2.2 rmind hilsubmatch(device_t parent, cfdata_t cf, const int *ldesc, void *aux) 178 1.2.2.2 rmind { 179 1.2.2.2 rmind struct hil_attach_args *ha = aux; 180 1.2.2.2 rmind 181 1.2.2.2 rmind if (cf->cf_loc[0] != -1 && 182 1.2.2.2 rmind cf->cf_loc[0] != ha->ha_code) 183 1.2.2.2 rmind return 0; 184 1.2.2.2 rmind 185 1.2.2.2 rmind return config_match(parent, cf, aux); 186 1.2.2.2 rmind } 187 1.2.2.2 rmind 188 1.2.2.2 rmind void 189 1.2.2.2 rmind hil_attach_deferred(device_t self) 190 1.2.2.2 rmind { 191 1.2.2.2 rmind struct hil_softc *sc = device_private(self); 192 1.2.2.2 rmind int tries; 193 1.2.2.2 rmind uint8_t db; 194 1.2.2.2 rmind 195 1.2.2.2 rmind sc->sc_status = HIL_STATUS_BUSY; 196 1.2.2.2 rmind 197 1.2.2.2 rmind /* 198 1.2.2.2 rmind * Initialize the loop: reconfigure, don't report errors, 199 1.2.2.2 rmind * put keyboard in cooked mode, and enable autopolling. 200 1.2.2.2 rmind */ 201 1.2.2.2 rmind db = LPC_RECONF | LPC_KBDCOOK | LPC_NOERROR | LPC_AUTOPOLL; 202 1.2.2.2 rmind send_hil_cmd(sc, HIL_WRITELPCTRL, &db, 1, NULL); 203 1.2.2.2 rmind 204 1.2.2.2 rmind /* 205 1.2.2.2 rmind * Delay one second for reconfiguration and then read the 206 1.2.2.2 rmind * data to clear the interrupt (if the loop reconfigured). 207 1.2.2.2 rmind */ 208 1.2.2.2 rmind DELAY(1000000); 209 1.2.2.2 rmind if (bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_STAT) & 210 1.2.2.2 rmind HIL_DATA_RDY) { 211 1.2.2.2 rmind db = bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_DATA); 212 1.2.2.2 rmind DELAY(1); 213 1.2.2.2 rmind } 214 1.2.2.2 rmind 215 1.2.2.2 rmind /* 216 1.2.2.2 rmind * The HIL loop may have reconfigured. If so we proceed on, 217 1.2.2.2 rmind * if not we loop a few times until a successful reconfiguration 218 1.2.2.2 rmind * is reported back to us. If the HIL loop is still lost after a 219 1.2.2.2 rmind * few seconds, give up. 220 1.2.2.2 rmind */ 221 1.2.2.2 rmind for (tries = 10; tries != 0; tries--) { 222 1.2.2.2 rmind if (send_hil_cmd(sc, HIL_READLPSTAT, NULL, 0, &db) == 0) { 223 1.2.2.2 rmind if (db & (LPS_CONFFAIL | LPS_CONFGOOD)) 224 1.2.2.2 rmind break; 225 1.2.2.2 rmind } 226 1.2.2.2 rmind 227 1.2.2.2 rmind #ifdef HILDEBUG 228 1.2.2.2 rmind aprint_debug(self, "%s: loop not ready, retrying...\n"); 229 1.2.2.2 rmind #endif 230 1.2.2.2 rmind 231 1.2.2.2 rmind DELAY(1000000); 232 1.2.2.2 rmind } 233 1.2.2.2 rmind 234 1.2.2.2 rmind if (tries == 0 || (db & LPS_CONFFAIL)) { 235 1.2.2.2 rmind aprint_normal_dev(self, "no devices\n"); 236 1.2.2.2 rmind sc->sc_pending = 0; 237 1.2.2.2 rmind if (tries == 0) 238 1.2.2.2 rmind return; 239 1.2.2.2 rmind } 240 1.2.2.2 rmind 241 1.2.2.2 rmind /* 242 1.2.2.2 rmind * Create asynchronous loop event handler thread. 243 1.2.2.2 rmind */ 244 1.2.2.2 rmind if (kthread_create(PRI_NONE, 0, NULL, hil_thread, sc, &sc->sc_thread, 245 1.2.2.2 rmind "%s", device_xname(sc->sc_dev)) != 0) { 246 1.2.2.2 rmind aprint_error_dev(self, "unable to create event thread\n"); 247 1.2.2.2 rmind return; 248 1.2.2.2 rmind } 249 1.2.2.2 rmind 250 1.2.2.2 rmind /* 251 1.2.2.2 rmind * Enable loop interrupts. 252 1.2.2.2 rmind */ 253 1.2.2.2 rmind send_hil_cmd(sc, HIL_INTON, NULL, 0, NULL); 254 1.2.2.2 rmind 255 1.2.2.2 rmind /* 256 1.2.2.2 rmind * Reconfigure if necessary 257 1.2.2.2 rmind */ 258 1.2.2.2 rmind sc->sc_status = HIL_STATUS_READY; 259 1.2.2.2 rmind hil_process_pending(sc); 260 1.2.2.2 rmind } 261 1.2.2.2 rmind 262 1.2.2.2 rmind /* 263 1.2.2.2 rmind * Asynchronous event processing 264 1.2.2.2 rmind */ 265 1.2.2.2 rmind 266 1.2.2.2 rmind int 267 1.2.2.2 rmind hil_intr(void *v) 268 1.2.2.2 rmind { 269 1.2.2.2 rmind struct hil_softc *sc = v; 270 1.2.2.2 rmind uint8_t c, stat; 271 1.2.2.2 rmind 272 1.2.2.2 rmind if (cold) 273 1.2.2.2 rmind return 0; 274 1.2.2.2 rmind 275 1.2.2.2 rmind stat = bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_STAT); 276 1.2.2.2 rmind 277 1.2.2.2 rmind /* 278 1.2.2.2 rmind * This should never happen if the interrupt comes from the 279 1.2.2.2 rmind * loop. 280 1.2.2.2 rmind */ 281 1.2.2.2 rmind if ((stat & HIL_DATA_RDY) == 0) 282 1.2.2.2 rmind return 0; /* not for us */ 283 1.2.2.2 rmind 284 1.2.2.2 rmind c = bus_space_read_1(sc->sc_bst, sc->sc_bsh, 285 1.2.2.2 rmind HILP_DATA); /* clears interrupt */ 286 1.2.2.2 rmind DELAY(1); 287 1.2.2.2 rmind 288 1.2.2.2 rmind hil_process_int(sc, stat, c); 289 1.2.2.2 rmind 290 1.2.2.2 rmind if (sc->sc_status != HIL_STATUS_BUSY) 291 1.2.2.2 rmind hil_process_pending(sc); 292 1.2.2.2 rmind 293 1.2.2.2 rmind return 1; 294 1.2.2.2 rmind } 295 1.2.2.2 rmind 296 1.2.2.2 rmind void 297 1.2.2.2 rmind hil_process_int(struct hil_softc *sc, uint8_t stat, uint8_t c) 298 1.2.2.2 rmind { 299 1.2.2.2 rmind device_t child; 300 1.2.2.2 rmind struct hildev_softc *hdsc; 301 1.2.2.2 rmind 302 1.2.2.2 rmind switch ((stat >> HIL_SSHIFT) & HIL_SMASK) { 303 1.2.2.2 rmind case HIL_STATUS: 304 1.2.2.2 rmind if (c & HIL_ERROR) { 305 1.2.2.2 rmind sc->sc_cmddone = 1; 306 1.2.2.2 rmind switch (c) { 307 1.2.2.2 rmind case HIL_RECONFIG: 308 1.2.2.2 rmind sc->sc_pending = HIL_PENDING_RECONFIG; 309 1.2.2.2 rmind break; 310 1.2.2.2 rmind case HIL_UNPLUGGED: 311 1.2.2.2 rmind sc->sc_pending = HIL_PENDING_UNPLUGGED; 312 1.2.2.2 rmind break; 313 1.2.2.2 rmind } 314 1.2.2.2 rmind break; 315 1.2.2.2 rmind } 316 1.2.2.2 rmind if (c & HIL_COMMAND) { 317 1.2.2.2 rmind if (c & HIL_POLLDATA) { /* End of data */ 318 1.2.2.2 rmind child = sc->sc_devices[sc->sc_actdev]; 319 1.2.2.2 rmind if (child != NULL) { 320 1.2.2.2 rmind hdsc = device_private(child); 321 1.2.2.2 rmind if (hdsc->sc_fn != NULL) 322 1.2.2.2 rmind (*hdsc->sc_fn)(hdsc, 323 1.2.2.2 rmind sc->sc_pollbp 324 1.2.2.2 rmind - sc->sc_pollbuf, 325 1.2.2.2 rmind sc->sc_pollbuf); 326 1.2.2.2 rmind } 327 1.2.2.2 rmind } else { /* End of command */ 328 1.2.2.2 rmind sc->sc_cmdending = 1; 329 1.2.2.2 rmind } 330 1.2.2.2 rmind sc->sc_actdev = 0; 331 1.2.2.2 rmind } else { 332 1.2.2.2 rmind if (c & HIL_POLLDATA) { /* Start of polled data */ 333 1.2.2.2 rmind sc->sc_actdev = (c & HIL_DEVMASK); 334 1.2.2.2 rmind sc->sc_pollbp = sc->sc_pollbuf; 335 1.2.2.2 rmind } else { /* Start of command */ 336 1.2.2.2 rmind if (sc->sc_cmddev == (c & HIL_DEVMASK)) { 337 1.2.2.2 rmind sc->sc_cmdbp = sc->sc_cmdbuf; 338 1.2.2.2 rmind sc->sc_actdev = 0; 339 1.2.2.2 rmind } 340 1.2.2.2 rmind } 341 1.2.2.2 rmind } 342 1.2.2.2 rmind break; 343 1.2.2.2 rmind case HIL_DATA: 344 1.2.2.2 rmind if (sc->sc_actdev != 0) /* Collecting poll data */ 345 1.2.2.2 rmind *sc->sc_pollbp++ = c; 346 1.2.2.2 rmind else { 347 1.2.2.2 rmind if (sc->sc_cmddev != 0) { /* Collecting cmd data */ 348 1.2.2.2 rmind if (sc->sc_cmdending) { 349 1.2.2.2 rmind sc->sc_cmddone = 1; 350 1.2.2.2 rmind sc->sc_cmdending = 0; 351 1.2.2.2 rmind } else 352 1.2.2.2 rmind *sc->sc_cmdbp++ = c; 353 1.2.2.2 rmind } 354 1.2.2.2 rmind } 355 1.2.2.2 rmind break; 356 1.2.2.2 rmind } 357 1.2.2.2 rmind } 358 1.2.2.2 rmind 359 1.2.2.2 rmind /* 360 1.2.2.2 rmind * Same as above, but in polled mode: return data as it gets seen, instead 361 1.2.2.2 rmind * of buffering it. 362 1.2.2.2 rmind */ 363 1.2.2.2 rmind int 364 1.2.2.2 rmind hil_process_poll(struct hil_softc *sc, uint8_t stat, uint8_t c) 365 1.2.2.2 rmind { 366 1.2.2.2 rmind uint8_t db; 367 1.2.2.2 rmind 368 1.2.2.2 rmind switch ((stat >> HIL_SSHIFT) & HIL_SMASK) { 369 1.2.2.2 rmind case HIL_STATUS: 370 1.2.2.2 rmind if (c & HIL_ERROR) { 371 1.2.2.2 rmind sc->sc_cmddone = 1; 372 1.2.2.2 rmind switch (c) { 373 1.2.2.2 rmind case HIL_RECONFIG: 374 1.2.2.2 rmind /* 375 1.2.2.2 rmind * Remember that a configuration event 376 1.2.2.2 rmind * occurred; it will be processed upon 377 1.2.2.2 rmind * leaving polled mode... 378 1.2.2.2 rmind */ 379 1.2.2.2 rmind sc->sc_pending = HIL_PENDING_RECONFIG; 380 1.2.2.2 rmind /* 381 1.2.2.2 rmind * However, the keyboard will come back as 382 1.2.2.2 rmind * cooked, and we rely on it being in raw 383 1.2.2.2 rmind * mode. So, put it back in raw mode right 384 1.2.2.2 rmind * now. 385 1.2.2.2 rmind */ 386 1.2.2.2 rmind db = 0; 387 1.2.2.2 rmind send_hil_cmd(sc, HIL_WRITEKBDSADR, &db, 388 1.2.2.2 rmind 1, NULL); 389 1.2.2.2 rmind break; 390 1.2.2.2 rmind case HIL_UNPLUGGED: 391 1.2.2.2 rmind /* 392 1.2.2.2 rmind * Remember that an unplugged event 393 1.2.2.2 rmind * occured; it will be processed upon 394 1.2.2.2 rmind * leaving polled mode... 395 1.2.2.2 rmind */ 396 1.2.2.2 rmind sc->sc_pending = HIL_PENDING_UNPLUGGED; 397 1.2.2.2 rmind break; 398 1.2.2.2 rmind } 399 1.2.2.2 rmind break; 400 1.2.2.2 rmind } 401 1.2.2.2 rmind if (c & HIL_COMMAND) { 402 1.2.2.2 rmind if (!(c & HIL_POLLDATA)) { 403 1.2.2.2 rmind /* End of command */ 404 1.2.2.2 rmind sc->sc_cmdending = 1; 405 1.2.2.2 rmind } 406 1.2.2.2 rmind sc->sc_actdev = 0; 407 1.2.2.2 rmind } else { 408 1.2.2.2 rmind if (c & HIL_POLLDATA) { 409 1.2.2.2 rmind /* Start of polled data */ 410 1.2.2.2 rmind sc->sc_actdev = (c & HIL_DEVMASK); 411 1.2.2.2 rmind sc->sc_pollbp = sc->sc_pollbuf; 412 1.2.2.2 rmind } else { 413 1.2.2.2 rmind /* Start of command - should not happen */ 414 1.2.2.2 rmind if (sc->sc_cmddev == (c & HIL_DEVMASK)) { 415 1.2.2.2 rmind sc->sc_cmdbp = sc->sc_cmdbuf; 416 1.2.2.2 rmind sc->sc_actdev = 0; 417 1.2.2.2 rmind } 418 1.2.2.2 rmind } 419 1.2.2.2 rmind } 420 1.2.2.2 rmind break; 421 1.2.2.2 rmind case HIL_DATA: 422 1.2.2.2 rmind if (sc->sc_actdev != 0) /* Collecting poll data */ 423 1.2.2.2 rmind return 1; 424 1.2.2.2 rmind else { 425 1.2.2.2 rmind if (sc->sc_cmddev != 0) { /* Discarding cmd data */ 426 1.2.2.2 rmind if (sc->sc_cmdending) { 427 1.2.2.2 rmind sc->sc_cmddone = 1; 428 1.2.2.2 rmind sc->sc_cmdending = 0; 429 1.2.2.2 rmind } 430 1.2.2.2 rmind } 431 1.2.2.2 rmind } 432 1.2.2.2 rmind break; 433 1.2.2.2 rmind } 434 1.2.2.2 rmind 435 1.2.2.2 rmind return 0; 436 1.2.2.2 rmind } 437 1.2.2.2 rmind 438 1.2.2.2 rmind void 439 1.2.2.2 rmind hil_thread(void *arg) 440 1.2.2.2 rmind { 441 1.2.2.2 rmind struct hil_softc *sc = arg; 442 1.2.2.2 rmind int s; 443 1.2.2.2 rmind 444 1.2.2.2 rmind for (;;) { 445 1.2.2.2 rmind s = splhil(); 446 1.2.2.2 rmind if (sc->sc_pending == 0) { 447 1.2.2.2 rmind splx(s); 448 1.2.2.2 rmind (void)tsleep(&sc->sc_pending, PWAIT, "hil_event", 0); 449 1.2.2.2 rmind continue; 450 1.2.2.2 rmind } 451 1.2.2.2 rmind 452 1.2.2.2 rmind switch (sc->sc_pending) { 453 1.2.2.2 rmind case HIL_PENDING_RECONFIG: 454 1.2.2.2 rmind sc->sc_pending = 0; 455 1.2.2.2 rmind hilconfig(sc, sc->sc_maxdev); 456 1.2.2.2 rmind break; 457 1.2.2.2 rmind case HIL_PENDING_UNPLUGGED: 458 1.2.2.2 rmind sc->sc_pending = 0; 459 1.2.2.2 rmind hilempty(sc); 460 1.2.2.2 rmind break; 461 1.2.2.2 rmind } 462 1.2.2.2 rmind splx(s); 463 1.2.2.2 rmind } 464 1.2.2.2 rmind } 465 1.2.2.2 rmind 466 1.2.2.2 rmind /* 467 1.2.2.2 rmind * Called after the loop has reconfigured. Here we need to: 468 1.2.2.2 rmind * - determine how many devices are on the loop 469 1.2.2.2 rmind * (some may have been added or removed) 470 1.2.2.2 rmind * - make sure all keyboards are in raw mode 471 1.2.2.2 rmind * 472 1.2.2.2 rmind * Note that our device state is now potentially invalid as 473 1.2.2.2 rmind * devices may no longer be where they were. What we should 474 1.2.2.2 rmind * do here is either track where the devices went and move 475 1.2.2.2 rmind * state around accordingly... 476 1.2.2.2 rmind * 477 1.2.2.2 rmind * Note that it is necessary that we operate the loop with the keyboards 478 1.2.2.2 rmind * in raw mode: they won't cause the loop to generate an NMI if the 479 1.2.2.2 rmind * ``reset'' key combination is pressed, and we do not handle the hil 480 1.2.2.2 rmind * NMI interrupt... 481 1.2.2.2 rmind */ 482 1.2.2.2 rmind void 483 1.2.2.2 rmind hilconfig(struct hil_softc *sc, u_int knowndevs) 484 1.2.2.2 rmind { 485 1.2.2.2 rmind struct hil_attach_args ha; 486 1.2.2.2 rmind uint8_t db; 487 1.2.2.2 rmind int id, s; 488 1.2.2.2 rmind 489 1.2.2.2 rmind s = splhil(); 490 1.2.2.2 rmind 491 1.2.2.2 rmind /* 492 1.2.2.2 rmind * Determine how many devices are on the loop. 493 1.2.2.2 rmind */ 494 1.2.2.2 rmind db = 0; 495 1.2.2.2 rmind send_hil_cmd(sc, HIL_READLPSTAT, NULL, 0, &db); 496 1.2.2.2 rmind sc->sc_maxdev = db & LPS_DEVMASK; 497 1.2.2.2 rmind #ifdef HILDEBUG 498 1.2.2.2 rmind printf("%s: %d device(s)\n", device_xname(sc->sc_dev), sc->sc_maxdev); 499 1.2.2.2 rmind #endif 500 1.2.2.2 rmind 501 1.2.2.2 rmind /* 502 1.2.2.2 rmind * Put all keyboards in raw mode now. 503 1.2.2.2 rmind */ 504 1.2.2.2 rmind db = 0; 505 1.2.2.2 rmind send_hil_cmd(sc, HIL_WRITEKBDSADR, &db, 1, NULL); 506 1.2.2.2 rmind 507 1.2.2.2 rmind /* 508 1.2.2.2 rmind * If the loop grew, attach new devices. 509 1.2.2.2 rmind */ 510 1.2.2.2 rmind for (id = knowndevs + 1; id <= sc->sc_maxdev; id++) { 511 1.2.2.2 rmind int len; 512 1.2.2.2 rmind const struct hildevice *hd; 513 1.2.2.2 rmind 514 1.2.2.2 rmind if (send_device_cmd(sc, id, HIL_IDENTIFY) != 0) { 515 1.2.2.2 rmind aprint_normal_dev(sc->sc_dev, 516 1.2.2.2 rmind "no answer from device %d\n", id); 517 1.2.2.2 rmind continue; 518 1.2.2.2 rmind } 519 1.2.2.2 rmind 520 1.2.2.2 rmind len = sc->sc_cmdbp - sc->sc_cmdbuf; 521 1.2.2.2 rmind if (len == 0) { 522 1.2.2.2 rmind #ifdef HILDEBUG 523 1.2.2.2 rmind printf("%s: no device at code %d\n", 524 1.2.2.2 rmind device_xname(sc->sc_dev), id); 525 1.2.2.2 rmind #endif 526 1.2.2.2 rmind continue; 527 1.2.2.2 rmind } 528 1.2.2.2 rmind 529 1.2.2.2 rmind /* Identify and attach device */ 530 1.2.2.2 rmind for (hd = hildevs; hd->minid >= 0; hd++) 531 1.2.2.2 rmind if (sc->sc_cmdbuf[0] >= hd->minid && 532 1.2.2.2 rmind sc->sc_cmdbuf[0] <= hd->maxid) { 533 1.2.2.2 rmind 534 1.2.2.2 rmind ha.ha_console = *sc->sc_console; 535 1.2.2.2 rmind ha.ha_code = id; 536 1.2.2.2 rmind ha.ha_type = hd->type; 537 1.2.2.2 rmind ha.ha_descr = hd->descr; 538 1.2.2.2 rmind ha.ha_infolen = len; 539 1.2.2.2 rmind memcpy(ha.ha_info, sc->sc_cmdbuf, len); 540 1.2.2.2 rmind 541 1.2.2.2 rmind sc->sc_devices[id] = 542 1.2.2.2 rmind config_found_sm_loc(sc->sc_dev, "hil", NULL, 543 1.2.2.2 rmind &ha, hildevprint, hilsubmatch); 544 1.2.2.2 rmind 545 1.2.2.2 rmind #if NHILKBD > 0 546 1.2.2.2 rmind /* 547 1.2.2.2 rmind * If we just attached a keyboard as console, 548 1.2.2.2 rmind * console choice is not indeterminate anymore. 549 1.2.2.2 rmind */ 550 1.2.2.2 rmind if (sc->sc_devices[id] != NULL && 551 1.2.2.2 rmind ha.ha_type == HIL_DEVICE_KEYBOARD && 552 1.2.2.2 rmind ha.ha_console != 0) 553 1.2.2.2 rmind *sc->sc_console = 1; 554 1.2.2.2 rmind #endif 555 1.2.2.2 rmind } 556 1.2.2.2 rmind } 557 1.2.2.2 rmind 558 1.2.2.2 rmind /* 559 1.2.2.2 rmind * Detach remaining devices, if the loop has shrunk. 560 1.2.2.2 rmind */ 561 1.2.2.2 rmind for (id = sc->sc_maxdev + 1; id < NHILD; id++) { 562 1.2.2.2 rmind if (sc->sc_devices[id] != NULL) 563 1.2.2.2 rmind config_detach(sc->sc_devices[id], 564 1.2.2.2 rmind DETACH_FORCE); 565 1.2.2.2 rmind sc->sc_devices[id] = NULL; 566 1.2.2.2 rmind } 567 1.2.2.2 rmind 568 1.2.2.2 rmind sc->sc_cmdbp = sc->sc_cmdbuf; 569 1.2.2.2 rmind 570 1.2.2.2 rmind splx(s); 571 1.2.2.2 rmind } 572 1.2.2.2 rmind 573 1.2.2.2 rmind /* 574 1.2.2.2 rmind * Called after the loop has been unplugged. We simply force detach of 575 1.2.2.2 rmind * all our children. 576 1.2.2.2 rmind */ 577 1.2.2.2 rmind void 578 1.2.2.2 rmind hilempty(struct hil_softc *sc) 579 1.2.2.2 rmind { 580 1.2.2.2 rmind uint8_t db; 581 1.2.2.2 rmind int id, s; 582 1.2.2.2 rmind u_int oldmaxdev; 583 1.2.2.2 rmind 584 1.2.2.2 rmind s = splhil(); 585 1.2.2.2 rmind 586 1.2.2.2 rmind /* 587 1.2.2.2 rmind * Wait for the loop to be stable. 588 1.2.2.2 rmind */ 589 1.2.2.2 rmind for (;;) { 590 1.2.2.2 rmind if (send_hil_cmd(sc, HIL_READLPSTAT, NULL, 0, &db) == 0) { 591 1.2.2.2 rmind if (db & (LPS_CONFFAIL | LPS_CONFGOOD)) 592 1.2.2.2 rmind break; 593 1.2.2.2 rmind } else { 594 1.2.2.2 rmind db = LPS_CONFFAIL; 595 1.2.2.2 rmind break; 596 1.2.2.2 rmind } 597 1.2.2.2 rmind } 598 1.2.2.2 rmind 599 1.2.2.2 rmind if (db & LPS_CONFFAIL) { 600 1.2.2.2 rmind sc->sc_maxdev = 0; 601 1.2.2.2 rmind } else { 602 1.2.2.2 rmind db = 0; 603 1.2.2.2 rmind send_hil_cmd(sc, HIL_READLPSTAT, NULL, 0, &db); 604 1.2.2.2 rmind oldmaxdev = sc->sc_maxdev; 605 1.2.2.2 rmind sc->sc_maxdev = db & LPS_DEVMASK; 606 1.2.2.2 rmind 607 1.2.2.2 rmind if (sc->sc_maxdev != 0) { 608 1.2.2.2 rmind /* 609 1.2.2.2 rmind * The loop was not unplugged after all, but its 610 1.2.2.2 rmind * configuration has changed. 611 1.2.2.2 rmind */ 612 1.2.2.2 rmind hilconfig(sc, oldmaxdev); 613 1.2.2.2 rmind return; 614 1.2.2.2 rmind } 615 1.2.2.2 rmind } 616 1.2.2.2 rmind 617 1.2.2.2 rmind /* 618 1.2.2.2 rmind * Now detach all hil devices. 619 1.2.2.2 rmind */ 620 1.2.2.2 rmind for (id = sc->sc_maxdev + 1; id < NHILD; id++) { 621 1.2.2.2 rmind if (sc->sc_devices[id] != NULL) 622 1.2.2.2 rmind config_detach(sc->sc_devices[id], 623 1.2.2.2 rmind DETACH_FORCE); 624 1.2.2.2 rmind sc->sc_devices[id] = NULL; 625 1.2.2.2 rmind } 626 1.2.2.2 rmind 627 1.2.2.2 rmind sc->sc_cmdbp = sc->sc_cmdbuf; 628 1.2.2.2 rmind 629 1.2.2.2 rmind splx(s); 630 1.2.2.2 rmind } 631 1.2.2.2 rmind 632 1.2.2.2 rmind /* 633 1.2.2.2 rmind * Low level routines which actually talk to the 8042 chip. 634 1.2.2.2 rmind */ 635 1.2.2.2 rmind 636 1.2.2.2 rmind /* 637 1.2.2.2 rmind * Send a command to the 8042 with zero or more bytes of data. 638 1.2.2.2 rmind * If rdata is non-null, wait for and return a byte of data. 639 1.2.2.2 rmind */ 640 1.2.2.2 rmind int 641 1.2.2.2 rmind send_hil_cmd(struct hil_softc *sc, u_int cmd, uint8_t *data, u_int dlen, 642 1.2.2.2 rmind uint8_t *rdata) 643 1.2.2.2 rmind { 644 1.2.2.2 rmind uint8_t status; 645 1.2.2.2 rmind int s; 646 1.2.2.2 rmind 647 1.2.2.2 rmind s = splhil(); 648 1.2.2.2 rmind 649 1.2.2.2 rmind if (hilwait(sc) == 0) { 650 1.2.2.2 rmind #ifdef HILDEBUG 651 1.2.2.2 rmind printf("%s: no answer from the loop\n", 652 1.2.2.2 rmind device_xname(sc->sc_dev)); 653 1.2.2.2 rmind #endif 654 1.2.2.2 rmind splx(s); 655 1.2.2.2 rmind return EBUSY; 656 1.2.2.2 rmind } 657 1.2.2.2 rmind 658 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_CMD, cmd); 659 1.2.2.2 rmind while (dlen--) { 660 1.2.2.2 rmind hilwait(sc); 661 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_DATA, *data++); 662 1.2.2.2 rmind DELAY(1); 663 1.2.2.2 rmind } 664 1.2.2.2 rmind if (rdata) { 665 1.2.2.2 rmind do { 666 1.2.2.2 rmind if (hildatawait(sc) == 0) { 667 1.2.2.2 rmind #ifdef HILDEBUG 668 1.2.2.2 rmind printf("%s: no answer from the loop\n", 669 1.2.2.2 rmind device_xname(sc->sc_dev)); 670 1.2.2.2 rmind #endif 671 1.2.2.2 rmind break; 672 1.2.2.2 rmind } 673 1.2.2.2 rmind status = bus_space_read_1(sc->sc_bst, sc->sc_bsh, 674 1.2.2.2 rmind HILP_STAT); 675 1.2.2.2 rmind *rdata = bus_space_read_1(sc->sc_bst, sc->sc_bsh, 676 1.2.2.2 rmind HILP_DATA); 677 1.2.2.2 rmind DELAY(1); 678 1.2.2.2 rmind } while (((status >> HIL_SSHIFT) & HIL_SMASK) != HIL_68K); 679 1.2.2.2 rmind } 680 1.2.2.2 rmind splx(s); 681 1.2.2.2 rmind return 0; 682 1.2.2.2 rmind } 683 1.2.2.2 rmind 684 1.2.2.2 rmind /* 685 1.2.2.2 rmind * Send a command to a device on the loop. 686 1.2.2.2 rmind * Since only one command can be active on the loop at any time, 687 1.2.2.2 rmind * we must ensure that we are not interrupted during this process. 688 1.2.2.2 rmind * Hence we mask interrupts to prevent potential access from most 689 1.2.2.2 rmind * interrupt routines and turn off auto-polling to disable the 690 1.2.2.2 rmind * internally generated poll commands. 691 1.2.2.2 rmind * Needs to be called at splhil(). 692 1.2.2.2 rmind */ 693 1.2.2.2 rmind int 694 1.2.2.2 rmind send_device_cmd(struct hil_softc *sc, u_int device, u_int cmd) 695 1.2.2.2 rmind { 696 1.2.2.2 rmind uint8_t status, c; 697 1.2.2.2 rmind int rc = 0; 698 1.2.2.2 rmind 699 1.2.2.2 rmind polloff(sc); 700 1.2.2.2 rmind 701 1.2.2.2 rmind sc->sc_cmdbp = sc->sc_cmdbuf; 702 1.2.2.2 rmind sc->sc_cmddev = device; 703 1.2.2.2 rmind 704 1.2.2.2 rmind if (hilwait(sc) == 0) { 705 1.2.2.2 rmind #ifdef HILDEBUG 706 1.2.2.2 rmind printf("%s: no answer from device %d\n", 707 1.2.2.2 rmind device_xname(sc->sc_dev), device); 708 1.2.2.2 rmind #endif 709 1.2.2.2 rmind rc = EBUSY; 710 1.2.2.2 rmind goto out; 711 1.2.2.2 rmind } 712 1.2.2.2 rmind 713 1.2.2.2 rmind /* 714 1.2.2.2 rmind * Transfer the command and device info to the chip 715 1.2.2.2 rmind */ 716 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_CMD, HIL_STARTCMD); 717 1.2.2.2 rmind hilwait(sc); 718 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_DATA, 8 + device); 719 1.2.2.2 rmind hilwait(sc); 720 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_DATA, cmd); 721 1.2.2.2 rmind hilwait(sc); 722 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_DATA, HIL_TIMEOUT); 723 1.2.2.2 rmind 724 1.2.2.2 rmind /* 725 1.2.2.2 rmind * Trigger the command and wait for completion 726 1.2.2.2 rmind */ 727 1.2.2.2 rmind hilwait(sc); 728 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_CMD, HIL_TRIGGER); 729 1.2.2.2 rmind sc->sc_cmddone = 0; 730 1.2.2.2 rmind do { 731 1.2.2.2 rmind if (hildatawait(sc) == 0) { 732 1.2.2.2 rmind #ifdef HILDEBUG 733 1.2.2.2 rmind printf("%s: no answer from device %d\n", 734 1.2.2.2 rmind device_xname(sc->sc_dev), device); 735 1.2.2.2 rmind #endif 736 1.2.2.2 rmind rc = EBUSY; 737 1.2.2.2 rmind break; 738 1.2.2.2 rmind } 739 1.2.2.2 rmind status = bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_STAT); 740 1.2.2.2 rmind c = bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_DATA); 741 1.2.2.2 rmind DELAY(1); 742 1.2.2.2 rmind hil_process_int(sc, status, c); 743 1.2.2.2 rmind } while (sc->sc_cmddone == 0); 744 1.2.2.2 rmind out: 745 1.2.2.2 rmind sc->sc_cmddev = 0; 746 1.2.2.2 rmind 747 1.2.2.2 rmind pollon(sc); 748 1.2.2.2 rmind return rc; 749 1.2.2.2 rmind } 750 1.2.2.2 rmind 751 1.2.2.2 rmind int 752 1.2.2.2 rmind send_hildev_cmd(struct hildev_softc *hdsc, u_int cmd, 753 1.2.2.2 rmind uint8_t *outbuf, u_int *outlen) 754 1.2.2.2 rmind { 755 1.2.2.2 rmind struct hil_softc *sc = device_private(device_parent(hdsc->sc_dev)); 756 1.2.2.2 rmind int s, rc; 757 1.2.2.2 rmind 758 1.2.2.2 rmind s = splhil(); 759 1.2.2.2 rmind 760 1.2.2.2 rmind if ((rc = send_device_cmd(sc, hdsc->sc_code, cmd)) == 0) { 761 1.2.2.2 rmind /* 762 1.2.2.2 rmind * Return the command response in the buffer if necessary 763 1.2.2.2 rmind */ 764 1.2.2.2 rmind if (outbuf != NULL && outlen != NULL) { 765 1.2.2.2 rmind *outlen = min(*outlen, sc->sc_cmdbp - sc->sc_cmdbuf); 766 1.2.2.2 rmind memcpy(outbuf, sc->sc_cmdbuf, *outlen); 767 1.2.2.2 rmind } 768 1.2.2.2 rmind } 769 1.2.2.2 rmind 770 1.2.2.2 rmind splx(s); 771 1.2.2.2 rmind return rc; 772 1.2.2.2 rmind } 773 1.2.2.2 rmind 774 1.2.2.2 rmind /* 775 1.2.2.2 rmind * Turn auto-polling off and on. 776 1.2.2.2 rmind */ 777 1.2.2.2 rmind void 778 1.2.2.2 rmind polloff(struct hil_softc *sc) 779 1.2.2.2 rmind { 780 1.2.2.2 rmind uint8_t db; 781 1.2.2.2 rmind 782 1.2.2.2 rmind if (hilwait(sc) == 0) 783 1.2.2.2 rmind return; 784 1.2.2.2 rmind 785 1.2.2.2 rmind /* 786 1.2.2.2 rmind * Turn off auto repeat 787 1.2.2.2 rmind */ 788 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_CMD, HIL_SETARR); 789 1.2.2.2 rmind hilwait(sc); 790 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_DATA, 0); 791 1.2.2.2 rmind 792 1.2.2.2 rmind /* 793 1.2.2.2 rmind * Turn off auto-polling 794 1.2.2.2 rmind */ 795 1.2.2.2 rmind hilwait(sc); 796 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_CMD, HIL_READLPCTRL); 797 1.2.2.2 rmind hildatawait(sc); 798 1.2.2.2 rmind db = bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_DATA); 799 1.2.2.2 rmind db &= ~LPC_AUTOPOLL; 800 1.2.2.2 rmind hilwait(sc); 801 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_CMD, HIL_WRITELPCTRL); 802 1.2.2.2 rmind hilwait(sc); 803 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_DATA, db); 804 1.2.2.2 rmind 805 1.2.2.2 rmind /* 806 1.2.2.2 rmind * Must wait until polling is really stopped 807 1.2.2.2 rmind */ 808 1.2.2.2 rmind do { 809 1.2.2.2 rmind hilwait(sc); 810 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_CMD, HIL_READBUSY); 811 1.2.2.2 rmind hildatawait(sc); 812 1.2.2.2 rmind db = bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_DATA); 813 1.2.2.2 rmind } while (db & BSY_LOOPBUSY); 814 1.2.2.2 rmind 815 1.2.2.2 rmind sc->sc_cmddone = 0; 816 1.2.2.2 rmind sc->sc_cmddev = 0; 817 1.2.2.2 rmind } 818 1.2.2.2 rmind 819 1.2.2.2 rmind void 820 1.2.2.2 rmind pollon(struct hil_softc *sc) 821 1.2.2.2 rmind { 822 1.2.2.2 rmind uint8_t db; 823 1.2.2.2 rmind 824 1.2.2.2 rmind if (hilwait(sc) == 0) 825 1.2.2.2 rmind return; 826 1.2.2.2 rmind 827 1.2.2.2 rmind /* 828 1.2.2.2 rmind * Turn on auto polling 829 1.2.2.2 rmind */ 830 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_CMD, HIL_READLPCTRL); 831 1.2.2.2 rmind hildatawait(sc); 832 1.2.2.2 rmind db = bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_DATA); 833 1.2.2.2 rmind db |= LPC_AUTOPOLL; 834 1.2.2.2 rmind hilwait(sc); 835 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_CMD, HIL_WRITELPCTRL); 836 1.2.2.2 rmind hilwait(sc); 837 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_DATA, db); 838 1.2.2.2 rmind 839 1.2.2.2 rmind /* 840 1.2.2.2 rmind * Turn off auto repeat - we emulate this through wscons 841 1.2.2.2 rmind */ 842 1.2.2.2 rmind hilwait(sc); 843 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_CMD, HIL_SETARR); 844 1.2.2.2 rmind hilwait(sc); 845 1.2.2.2 rmind bus_space_write_1(sc->sc_bst, sc->sc_bsh, HILP_DATA, 0); 846 1.2.2.2 rmind DELAY(1); 847 1.2.2.2 rmind } 848 1.2.2.2 rmind 849 1.2.2.2 rmind void 850 1.2.2.2 rmind hil_set_poll(struct hil_softc *sc, int on) 851 1.2.2.2 rmind { 852 1.2.2.2 rmind if (on) { 853 1.2.2.2 rmind pollon(sc); 854 1.2.2.2 rmind } else { 855 1.2.2.2 rmind hil_process_pending(sc); 856 1.2.2.2 rmind send_hil_cmd(sc, HIL_INTON, NULL, 0, NULL); 857 1.2.2.2 rmind } 858 1.2.2.2 rmind } 859 1.2.2.2 rmind 860 1.2.2.2 rmind int 861 1.2.2.2 rmind hil_poll_data(struct hildev_softc *hdsc, uint8_t *stat, uint8_t *data) 862 1.2.2.2 rmind { 863 1.2.2.2 rmind struct hil_softc *sc = device_private(device_parent(hdsc->sc_dev)); 864 1.2.2.2 rmind uint8_t s, c; 865 1.2.2.2 rmind 866 1.2.2.2 rmind s = bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_STAT); 867 1.2.2.2 rmind if ((s & HIL_DATA_RDY) == 0) 868 1.2.2.2 rmind return -1; 869 1.2.2.2 rmind 870 1.2.2.2 rmind c = bus_space_read_1(sc->sc_bst, sc->sc_bsh, HILP_DATA); 871 1.2.2.2 rmind DELAY(1); 872 1.2.2.2 rmind 873 1.2.2.2 rmind if (hil_process_poll(sc, s, c)) { 874 1.2.2.2 rmind /* Discard any data not for us */ 875 1.2.2.2 rmind if (sc->sc_actdev == hdsc->sc_code) { 876 1.2.2.2 rmind *stat = s; 877 1.2.2.2 rmind *data = c; 878 1.2.2.2 rmind return 0; 879 1.2.2.2 rmind } 880 1.2.2.2 rmind } 881 1.2.2.2 rmind 882 1.2.2.2 rmind return -1; 883 1.2.2.2 rmind } 884
Indexes created Fri Oct 03 15:10:06 GMT 2025