/* $NetBSD: pccons.c,v 1.89 1995/05/04 19:35:20 cgd Exp $ */ /*- * Copyright (c) 1993, 1994, 1995 Charles Hannum. All rights reserved. * Copyright (c) 1990 The Regents of the University of California. * All rights reserved. * * This code is derived from software contributed to Berkeley by * William Jolitz and Don Ahn. * * Copyright (c) 1994 Charles Hannum. * Copyright (c) 1992, 1993 Erik Forsberg. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by the University of * California, Berkeley and its contributors. * 4. Neither the name of the University nor the names of its contributors * may be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * @(#)pccons.c 5.11 (Berkeley) 5/21/91 */ /* * code to work keyboard & display for PC-style console */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #define XFREE86_BUG_COMPAT #ifndef BEEP_FREQ #define BEEP_FREQ 1600 #endif #ifndef BEEP_TIME #define BEEP_TIME (hz/5) #endif #define PCBURST 128 static u_short *Crtat; /* pointer to backing store */ static u_short *crtat; /* pointer to current char */ static u_char async, kernel, polling; /* Really, you don't want to know. */ static u_char lock_state = 0x00, /* all off */ old_lock_state = 0xff, typematic_rate = 0xff, /* don't update until set by user */ old_typematic_rate = 0xff; static u_short cursor_shape = 0xffff, /* don't update until set by user */ old_cursor_shape = 0xffff; int pc_xmode = 0; /* * Keyboard output queue. */ int kb_oq_put = 0; int kb_oq_get = 0; u_char kb_oq[8]; #define PCUNIT(x) (minor(x)) static struct video_state { int cx, cy; /* escape parameters */ int row, col; /* current cursor position */ int nrow, ncol, nchr; /* current screen geometry */ u_char state; /* parser state */ #define VSS_ESCAPE 1 #define VSS_EBRACE 2 #define VSS_EPARAM 3 char so; /* in standout mode? */ char color; /* color or mono display */ char at; /* normal attributes */ char so_at; /* standout attributes */ } vs; struct pc_softc { struct device sc_dev; struct tty *sc_tty; }; struct pms_softc { /* driver status information */ struct device sc_dev; struct clist sc_q; struct selinfo sc_rsel; u_char sc_state; /* mouse driver state */ #define PMS_OPEN 0x01 /* device is open */ #define PMS_ASLP 0x02 /* waiting for mouse data */ u_char sc_status; /* mouse button status */ int sc_x, sc_y; /* accumulated motion in the X,Y axis */ }; int pcmatch __P((struct device *, void *, void *)); void pcattach __P((struct device *, struct device *, void *)); int pcintr __P((void *)); struct cfdriver pccd = { NULL, "pc", pcmatch, pcattach, DV_TTY, sizeof(struct pc_softc) }; int pmsprobe __P((struct device *, void *, void *)); void pmsattach __P((struct device *, struct device *, void *)); int pmsintr __P((void *)); struct cfdriver pmscd = { NULL, "pms", pmsprobe, pmsattach, DV_TTY, sizeof(struct pms_softc) }; #define PMSUNIT(dev) (minor(dev)) #define COL 80 #define ROW 25 #define CHR 2 /* * DANGER WIL ROBINSON -- the values of SCROLL, NUM, CAPS, and ALT are * important. */ #define SCROLL 0x0001 /* stop output */ #define NUM 0x0002 /* numeric shift cursors vs. numeric */ #define CAPS 0x0004 /* caps shift -- swaps case of letter */ #define SHIFT 0x0008 /* keyboard shift */ #define CTL 0x0010 /* control shift -- allows ctl function */ #define ASCII 0x0020 /* ascii code for this key */ #define ALTGR 0x0040 /* alt graphic */ #define ALT 0x0080 /* alternate shift -- alternate chars */ #define FUNC 0x0100 /* function key */ #define KP 0x0200 /* Keypad keys */ #define NONE 0x0400 /* no function */ static unsigned int addr_6845 = MONO_BASE; char *sget __P((void)); void sput __P((u_char *, int)); void pcstart(); int pcparam(); char partab[]; extern pcopen(dev_t, int, int, struct proc *); #define KBD_DELAY \ DELAY(10); static inline int kbd_wait_output() { u_int i; for (i = 100000; i; i--) if ((inb(KBSTATP) & KBS_IBF) == 0) { KBD_DELAY; return 1; } return 0; } static inline int kbd_wait_input() { u_int i; for (i = 100000; i; i--) if ((inb(KBSTATP) & KBS_DIB) != 0) { KBD_DELAY; return 1; } return 0; } static inline void kbd_flush_input() { u_char c; while (c = inb(KBSTATP) & 0x03) if ((c & KBS_DIB) == KBS_DIB) { /* XXX - delay is needed to prevent some keyboards from wedging when the system boots */ delay(6); (void) inb(KBDATAP); } } #if 1 /* * Get the current command byte. */ static u_char kbc_get8042cmd() { if (!kbd_wait_output()) return -1; outb(KBCMDP, K_RDCMDBYTE); if (!kbd_wait_input()) return -1; return inb(KBDATAP); } #endif /* * Pass command byte to keyboard controller (8042). */ static int kbc_put8042cmd(val) u_char val; { if (!kbd_wait_output()) return 0; outb(KBCMDP, K_LDCMDBYTE); if (!kbd_wait_output()) return 0; outb(KBOUTP, val); return 1; } /* * Pass command to keyboard itself */ int kbd_cmd(val, polling) u_char val; u_char polling; { u_int retries = 3; register u_int i; if(!polling) { i = spltty(); if(kb_oq_get == kb_oq_put) { outb(KBOUTP, val); } kb_oq[kb_oq_put] = val; kb_oq_put = (kb_oq_put + 1) & 7; splx(i); return(1); } else do { if (!kbd_wait_output()) return 0; outb(KBOUTP, val); for (i = 100000; i; i--) { if (inb(KBSTATP) & KBS_DIB) { register u_char c; KBD_DELAY; c = inb(KBDATAP); if (c == KBR_ACK || c == KBR_ECHO) { return 1; } if (c == KBR_RESEND) { break; } #ifdef DIAGNOSTIC printf("kbd_cmd: input char %x lost\n", c); #endif } } } while (--retries); return 0; } void set_cursor_shape() { register int iobase = addr_6845; outb(iobase, 10); outb(iobase+1, cursor_shape >> 8); outb(iobase, 11); outb(iobase+1, cursor_shape); old_cursor_shape = cursor_shape; } void get_cursor_shape() { register int iobase = addr_6845; outb(iobase, 10); cursor_shape = inb(iobase+1) << 8; outb(iobase, 11); cursor_shape |= inb(iobase+1); /* * real 6845's, as found on, MDA, Hercules or CGA cards, do * not support reading the cursor shape registers. the 6845 * tri-states it's data bus. This is _normally_ read by the * cpu as either 0x00 or 0xff.. in which case we just use * a line cursor. */ if (cursor_shape == 0x0000 || cursor_shape == 0xffff) cursor_shape = 0x0b10; else cursor_shape &= 0x1f1f; } void do_async_update(poll) u_char poll; { int pos; static int old_pos = -1; async = 0; if (lock_state != old_lock_state) { old_lock_state = lock_state; if (!kbd_cmd(KBC_MODEIND, poll) || !kbd_cmd(lock_state, poll)) { printf("pc: timeout updating leds\n"); (void) kbd_cmd(KBC_ENABLE, poll); } } if (typematic_rate != old_typematic_rate) { old_typematic_rate = typematic_rate; if (!kbd_cmd(KBC_TYPEMATIC, poll) || !kbd_cmd(typematic_rate, poll)) { printf("pc: timeout updating typematic rate\n"); (void) kbd_cmd(KBC_ENABLE, poll); } } if (pc_xmode > 0) return; pos = crtat - Crtat; if (pos != old_pos) { register int iobase = addr_6845; outb(iobase, 14); outb(iobase+1, pos >> 8); outb(iobase, 15); outb(iobase+1, pos); old_pos = pos; } if (cursor_shape != old_cursor_shape) set_cursor_shape(); } void async_update() { if (kernel || polling) { if (async) untimeout(do_async_update, NULL); do_async_update(1); } else { if (async) return; async = 1; timeout(do_async_update, NULL, 1); } } /* * these are both bad jokes */ int pcmatch(parent, cfdata, aux) struct device *parent; void *cfdata, *aux; { struct confargs *ca = aux; u_int i; /* Make shure we're looking for this type of device */ if(!BUS_MATCHNAME(ca, "pc")) return(0); /* Enable interrupts and keyboard, etc. */ if (!kbc_put8042cmd(CMDBYTE)) { printf("pcmatch: command error\n"); return 0; } #if 1 /* Flush any garbage. */ kbd_flush_input(); /* Reset the keyboard. */ if (!kbd_cmd(KBC_RESET, 1)) { printf("pcmatch: reset error %d\n", 1); goto lose; } for (i = 600000; i; i--) if ((inb(KBSTATP) & KBS_DIB) != 0) { KBD_DELAY; break; } if (i == 0 || inb(KBDATAP) != KBR_RSTDONE) { printf("pcmatch: reset error %d\n", 2); goto lose; } /* * Some keyboards seem to leave a second ack byte after the reset. * This is kind of stupid, but we account for them anyway by just * flushing the buffer. */ kbd_flush_input(); /* Just to be sure. */ if (!kbd_cmd(KBC_ENABLE, 1)) { printf("pcmatch: reset error %d\n", 3); goto lose; } /* * Some keyboard/8042 combinations do not seem to work if the keyboard * is set to table 1; in fact, it would appear that some keyboards just * ignore the command altogether. So by default, we use the AT scan * codes and have the 8042 translate them. Unfortunately, this is * known to not work on some PS/2 machines. We try desparately to deal * with this by checking the (lack of a) translate bit in the 8042 and * attempting to set the keyboard to XT mode. If this all fails, well, * tough luck. * * XXX It would perhaps be a better choice to just use AT scan codes * and not bother with this. */ if (kbc_get8042cmd() & KC8_TRANS) { /* The 8042 is translating for us; use AT codes. */ if (!kbd_cmd(KBC_SETTABLE, 1) || !kbd_cmd(2, 1)) { printf("pcmatch: reset error %d\n", 4); goto lose; } } else { /* Stupid 8042; set keyboard to XT codes. */ if (!kbd_cmd(KBC_SETTABLE, 1) || !kbd_cmd(1, 1)) { printf("pcmatch: reset error %d\n", 5); goto lose; } } lose: /* * Technically, we should probably fail the match. But we'll be nice * and allow keyboard-less machines to boot with the console. */ #endif return 1; } void pcattach(parent, self, aux) struct device *parent, *self; void *aux; { struct confargs *ca = aux; struct pc_softc *sc = (void *)self; printf(": %s\n", vs.color ? "color" : "mono"); do_async_update(1); BUS_INTR_ESTABLISH(ca, pcintr, (void *)(long)sc); } int pcopen(dev, flag, mode, p) dev_t dev; int flag, mode; struct proc *p; { struct pc_softc *sc; int unit = PCUNIT(dev); struct tty *tp; if (unit >= pccd.cd_ndevs) return ENXIO; sc = pccd.cd_devs[unit]; if (sc == 0) return ENXIO; if (!sc->sc_tty) { tp = sc->sc_tty = ttymalloc(); } else { tp = sc->sc_tty; } tp->t_oproc = pcstart; tp->t_param = pcparam; tp->t_dev = dev; if ((tp->t_state & TS_ISOPEN) == 0) { tp->t_state |= TS_WOPEN; ttychars(tp); tp->t_iflag = TTYDEF_IFLAG; tp->t_oflag = TTYDEF_OFLAG; tp->t_cflag = TTYDEF_CFLAG; tp->t_lflag = TTYDEF_LFLAG; tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED; pcparam(tp, &tp->t_termios); ttsetwater(tp); } else if (tp->t_state&TS_XCLUDE && p->p_ucred->cr_uid != 0) return EBUSY; tp->t_state |= TS_CARR_ON; return ((*linesw[tp->t_line].l_open)(dev, tp)); } int pcclose(dev, flag, mode, p) dev_t dev; int flag, mode; struct proc *p; { struct pc_softc *sc = pccd.cd_devs[PCUNIT(dev)]; struct tty *tp = sc->sc_tty; (*linesw[tp->t_line].l_close)(tp, flag); ttyclose(tp); #ifdef notyet /* XXX */ ttyfree(tp); #endif return(0); } int pcread(dev, uio, flag) dev_t dev; struct uio *uio; int flag; { struct pc_softc *sc = pccd.cd_devs[PCUNIT(dev)]; struct tty *tp = sc->sc_tty; return ((*linesw[tp->t_line].l_read)(tp, uio, flag)); } int pcwrite(dev, uio, flag) dev_t dev; struct uio *uio; int flag; { struct pc_softc *sc = pccd.cd_devs[PCUNIT(dev)]; struct tty *tp = sc->sc_tty; return ((*linesw[tp->t_line].l_write)(tp, uio, flag)); } struct tty * pctty(dev) dev_t dev; { struct pc_softc *sc = pccd.cd_devs[PCUNIT(dev)]; struct tty *tp = sc->sc_tty; return (tp); } /* * Got a console receive interrupt - * the console processor wants to give us a character. * Catch the character, and see who it goes to. */ int pcintr(arg) void *arg; { struct pc_softc *sc = arg; register struct tty *tp = sc->sc_tty; u_char *cp; if ((inb(KBSTATP) & KBS_DIB) == 0) return 0; if (polling) return 1; do { cp = sget(); if (!tp || (tp->t_state & TS_ISOPEN) == 0) return 1; if (cp) do (*linesw[tp->t_line].l_rint)(*cp++, tp); while (*cp); } while (inb(KBSTATP) & KBS_DIB); return 1; } int pcioctl(dev, cmd, data, flag, p) dev_t dev; u_long cmd; caddr_t data; int flag; struct proc *p; { struct pc_softc *sc = pccd.cd_devs[PCUNIT(dev)]; struct tty *tp = sc->sc_tty; int error; error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, p); if (error >= 0) return error; error = ttioctl(tp, cmd, data, flag, p); if (error >= 0) return error; switch (cmd) { case CONSOLE_X_MODE_ON: pc_xmode_on(); return 0; case CONSOLE_X_MODE_OFF: pc_xmode_off(); return 0; case CONSOLE_X_BELL: /* * If set, data is a pointer to a length 2 array of * integers. data[0] is the pitch in Hz and data[1] * is the duration in msec. */ if (data) sysbeep(((int*)data)[0], (((int*)data)[1] * hz) / 1000); else sysbeep(BEEP_FREQ, BEEP_TIME); return 0; case CONSOLE_SET_TYPEMATIC_RATE: { u_char rate; if (!data) return EINVAL; rate = *((u_char *)data); /* * Check that it isn't too big (which would cause it to be * confused with a command). */ if (rate & 0x80) return EINVAL; typematic_rate = rate; async_update(); return 0; } default: return ENOTTY; } #ifdef DIAGNOSTIC panic("pcioctl: impossible"); #endif } void pcstart(tp) struct tty *tp; { struct clist *cl; int s, len, n; u_char buf[PCBURST]; s = spltty(); if (tp->t_state & (TS_TIMEOUT | TS_BUSY | TS_TTSTOP)) goto out; tp->t_state |= TS_BUSY; splx(s); /* * We need to do this outside spl since it could be fairly * expensive and we don't want our serial ports to overflow. */ cl = &tp->t_outq; len = q_to_b(cl, buf, PCBURST); sput(buf, len); s = spltty(); tp->t_state &= ~TS_BUSY; if (cl->c_cc) { tp->t_state |= TS_TIMEOUT; timeout(ttrstrt, tp, 1); } if (cl->c_cc <= tp->t_lowat) { if (tp->t_state & TS_ASLEEP) { tp->t_state &= ~TS_ASLEEP; wakeup(cl); } selwakeup(&tp->t_wsel); } out: splx(s); } void pcstop(tp, flag) struct tty *tp; int flag; { } void pccnprobe(cp) struct consdev *cp; { int maj; /* locate the major number */ for (maj = 0; maj < nchrdev; maj++) if (cdevsw[maj].d_open == pcopen) break; /* initialize required fields */ cp->cn_dev = makedev(maj, 0); cp->cn_pri = CN_INTERNAL; } /* ARGSUSED */ void pccninit(cp) struct consdev *cp; { /* * For now, don't screw with it. */ /* crtat = 0; */ } /* ARGSUSED */ void pccnputc(dev, c) dev_t dev; char c; { u_char oldkernel = kernel; kernel = 1; if (c == '\n') sput("\r\n", 2); else sput(&c, 1); kernel = oldkernel; } /* ARGSUSED */ pccngetc(dev) dev_t dev; { register char *cp; if (pc_xmode > 0) return 0; do { /* wait for byte */ while ((inb(KBSTATP) & KBS_DIB) == 0); /* see if it's worthwhile */ cp = sget(); } while (!cp); if (*cp == '\r') return '\n'; return *cp; } void pccnpollc(dev, on) dev_t dev; int on; { polling = on; if (!on) { int unit; struct pc_softc *sc; int s; /* * If disabling polling on a device that's been configured, * make sure there are no bytes left in the FIFO, holding up * the interrupt line. Otherwise we won't get any further * interrupts. */ unit = PCUNIT(dev); if (pccd.cd_ndevs > unit) { sc = pccd.cd_devs[unit]; if (sc != 0) { s = spltty(); pcintr(sc); splx(s); } } } } /* * Set line parameters. */ int pcparam(tp, t) struct tty *tp; struct termios *t; { tp->t_ispeed = t->c_ispeed; tp->t_ospeed = t->c_ospeed; tp->t_cflag = t->c_cflag; return 0; } #define wrtchar(c, at) do {\ char *cp = (char *)crtat; *cp++ = (c); *cp = (at); crtat++; vs.col++; \ } while (0) /* translate ANSI color codes to standard pc ones */ static char fgansitopc[] = { FG_BLACK, FG_RED, FG_GREEN, FG_BROWN, FG_BLUE, FG_MAGENTA, FG_CYAN, FG_LIGHTGREY }; static char bgansitopc[] = { BG_BLACK, BG_RED, BG_GREEN, BG_BROWN, BG_BLUE, BG_MAGENTA, BG_CYAN, BG_LIGHTGREY }; static u_char iso2ibm437[] = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0xff, 0xad, 0x9b, 0x9c, 0, 0x9d, 0, 0x40, 0x6f, 0x63, 0x61, 0xae, 0, 0, 0, 0, 0xf8, 0xf1, 0xfd, 0x33, 0, 0xe6, 0, 0xfa, 0, 0x31, 0x6f, 0xaf, 0xac, 0xab, 0, 0xa8, 0x41, 0x41, 0x41, 0x41, 0x8e, 0x8f, 0x92, 0x80, 0x45, 0x90, 0x45, 0x45, 0x49, 0x49, 0x49, 0x49, 0x81, 0xa5, 0x4f, 0x4f, 0x4f, 0x4f, 0x99, 0x4f, 0x4f, 0x55, 0x55, 0x55, 0x9a, 0x59, 0, 0xe1, 0x85, 0xa0, 0x83, 0x61, 0x84, 0x86, 0x91, 0x87, 0x8a, 0x82, 0x88, 0x89, 0x8d, 0xa1, 0x8c, 0x8b, 0, 0xa4, 0x95, 0xa2, 0x93, 0x6f, 0x94, 0x6f, 0x6f, 0x97, 0xa3, 0x96, 0x81, 0x98, 0, 0 }; /* * `pc3' termcap emulation. */ void sput(cp, n) u_char *cp; int n; { u_char c, scroll = 0; if (pc_xmode > 0) return; if (crtat == 0) { u_short volatile *cp; u_short was; unsigned cursorat; cp = (u_short *)CGA_BUF; was = *cp; *cp = (u_short) 0xA55A; if (*cp != 0xA55A) { cp = (u_short *)MONO_BUF; addr_6845 = MONO_BASE; vs.color = 0; } else { *cp = was; addr_6845 = CGA_BASE; vs.color = 1; } /* Extract cursor location */ outb(addr_6845, 14); cursorat = inb(addr_6845+1) << 8; outb(addr_6845, 15); cursorat |= inb(addr_6845+1); #ifdef FAT_CURSOR cursor_shape = 0x0012; #else get_cursor_shape(); #endif Crtat = (u_short *)cp; crtat = (u_short *)(cp + cursorat); vs.ncol = COL; vs.nrow = ROW; vs.nchr = COL * ROW; vs.at = FG_LIGHTGREY | BG_BLACK; if (vs.color == 0) vs.so_at = FG_BLACK | BG_LIGHTGREY; else vs.so_at = FG_YELLOW | BG_BLACK; fillw((vs.at << 8) | ' ', crtat, vs.nchr - cursorat); } while (n--) { if (!(c = *cp++)) continue; switch (c) { case 0x1B: if (vs.state >= VSS_ESCAPE) { wrtchar(c, vs.so_at); vs.state = 0; goto maybe_scroll; } else vs.state = VSS_ESCAPE; break; case '\t': { int inccol = 8 - (vs.col & 7); crtat += inccol; vs.col += inccol; } maybe_scroll: if (vs.col >= COL) { vs.col -= COL; scroll = 1; } break; case '\010': if (crtat <= Crtat) break; --crtat; if (--vs.col < 0) vs.col += COL; /* non-destructive backspace */ break; case '\r': crtat -= vs.col; vs.col = 0; break; case '\n': crtat += vs.ncol; scroll = 1; break; default: bypass: switch (vs.state) { case 0: if (c == '\a') sysbeep(BEEP_FREQ, BEEP_TIME); else { /* * If we're outputting multiple printed * characters, just blast them to the * screen until we reach the end of the * buffer or a control character. This * saves time by short-circuiting the * switch. * If we reach the end of the line, we * break to do a scroll check. */ for (;;) { if (c & 0x80) c = iso2ibm437[c&0x7f]; if (vs.so) wrtchar(c, vs.so_at); else wrtchar(c, vs.at); if (vs.col >= vs.ncol) { vs.col = 0; scroll = 1; break; } if (!n || (c = *cp) < ' ') break; n--, cp++; } } break; case VSS_ESCAPE: if (c == '[') { /* Start ESC [ sequence */ vs.cx = vs.cy = 0; vs.state = VSS_EBRACE; } else if (c == 'c') { /* Clear screen & home */ fillw((vs.at << 8) | ' ', Crtat, vs.nchr); crtat = Crtat; vs.col = 0; vs.state = 0; } else { /* Invalid, clear state */ wrtchar(c, vs.so_at); vs.state = 0; goto maybe_scroll; } break; default: /* VSS_EBRACE or VSS_EPARAM */ switch (c) { int pos; case 'm': if (!vs.cx) vs.so = 0; else vs.so = 1; vs.state = 0; break; case 'A': { /* back cx rows */ int cx = vs.cx; if (cx <= 0) cx = 1; else cx %= vs.nrow; pos = crtat - Crtat; pos -= vs.ncol * cx; if (pos < 0) pos += vs.nchr; crtat = Crtat + pos; vs.state = 0; break; } case 'B': { /* down cx rows */ int cx = vs.cx; if (cx <= 0) cx = 1; else cx %= vs.nrow; pos = crtat - Crtat; pos += vs.ncol * cx; if (pos >= vs.nchr) pos -= vs.nchr; crtat = Crtat + pos; vs.state = 0; break; } case 'C': { /* right cursor */ int cx = vs.cx, col = vs.col; if (cx <= 0) cx = 1; else cx %= vs.ncol; pos = crtat - Crtat; pos += cx; col += cx; if (col >= vs.ncol) { pos -= vs.ncol; col -= vs.ncol; } vs.col = col; crtat = Crtat + pos; vs.state = 0; break; } case 'D': { /* left cursor */ int cx = vs.cx, col = vs.col; if (cx <= 0) cx = 1; else cx %= vs.ncol; pos = crtat - Crtat; pos -= cx; col -= cx; if (col < 0) { pos += vs.ncol; col += vs.ncol; } vs.col = col; crtat = Crtat + pos; vs.state = 0; break; } case 'J': /* Clear ... */ switch (vs.cx) { case 0: /* ... to end of display */ fillw((vs.at << 8) | ' ', crtat, Crtat + vs.nchr - crtat); break; case 1: /* ... to next location */ fillw((vs.at << 8) | ' ', Crtat, crtat - Crtat + 1); break; case 2: /* ... whole display */ fillw((vs.at << 8) | ' ', Crtat, vs.nchr); break; } vs.state = 0; break; case 'K': /* Clear line ... */ switch (vs.cx) { case 0: /* ... current to EOL */ fillw((vs.at << 8) | ' ', crtat, vs.ncol - vs.col); break; case 1: /* ... beginning to next */ fillw((vs.at << 8) | ' ', crtat - vs.col, vs.col + 1); break; case 2: /* ... entire line */ fillw((vs.at << 8) | ' ', crtat - vs.col, vs.ncol); break; } vs.state = 0; break; case 'f': /* in system V consoles */ case 'H': { /* Cursor move */ int cx = vs.cx, cy = vs.cy; if (!cx || !cy) { crtat = Crtat; vs.col = 0; } else { if (cx > vs.nrow) cx = vs.nrow; if (cy > vs.ncol) cy = vs.ncol; crtat = Crtat + (cx - 1) * vs.ncol + cy - 1; vs.col = cy - 1; } vs.state = 0; break; } case 'M': { /* delete cx rows */ u_short *crtAt = crtat - vs.col; int cx = vs.cx, row = (crtAt - Crtat) / vs.ncol, nrow = vs.nrow - row; if (cx <= 0) cx = 1; else if (cx > nrow) cx = nrow; if (cx < nrow) bcopy(crtAt + vs.ncol * cx, crtAt, vs.ncol * (nrow - cx) * CHR); fillw((vs.at << 8) | ' ', crtAt + vs.ncol * (nrow - cx), vs.ncol * cx); vs.state = 0; break; } case 'S': { /* scroll up cx lines */ int cx = vs.cx; if (cx <= 0) cx = 1; else if (cx > vs.nrow) cx = vs.nrow; if (cx < vs.nrow) bcopy(Crtat + vs.ncol * cx, Crtat, vs.ncol * (vs.nrow - cx) * CHR); fillw((vs.at << 8) | ' ', Crtat + vs.ncol * (vs.nrow - cx), vs.ncol * cx); /* crtat -= vs.ncol * cx; /* XXX */ vs.state = 0; break; } case 'L': { /* insert cx rows */ u_short *crtAt = crtat - vs.col; int cx = vs.cx, row = (crtAt - Crtat) / vs.ncol, nrow = vs.nrow - row; if (cx <= 0) cx = 1; else if (cx > nrow) cx = nrow; if (cx < nrow) bcopy(crtAt, crtAt + vs.ncol * cx, vs.ncol * (nrow - cx) * CHR); fillw((vs.at << 8) | ' ', crtAt, vs.ncol * cx); vs.state = 0; break; } case 'T': { /* scroll down cx lines */ int cx = vs.cx; if (cx <= 0) cx = 1; else if (cx > vs.nrow) cx = vs.nrow; if (cx < vs.nrow) bcopy(Crtat, Crtat + vs.ncol * cx, vs.ncol * (vs.nrow - cx) * CHR); fillw((vs.at << 8) | ' ', Crtat, vs.ncol * cx); /* crtat += vs.ncol * cx; /* XXX */ vs.state = 0; break; } case ';': /* Switch params in cursor def */ vs.state = VSS_EPARAM; break; case 'r': vs.so_at = (vs.cx & FG_MASK) | ((vs.cy << 4) & BG_MASK); vs.state = 0; break; case 'x': /* set attributes */ switch (vs.cx) { case 0: vs.at = FG_LIGHTGREY | BG_BLACK; break; case 1: /* ansi background */ if (!vs.color) break; vs.at &= FG_MASK; vs.at |= bgansitopc[vs.cy & 7]; break; case 2: /* ansi foreground */ if (!vs.color) break; vs.at &= BG_MASK; vs.at |= fgansitopc[vs.cy & 7]; break; case 3: /* pc text attribute */ if (vs.state >= VSS_EPARAM) vs.at = vs.cy; break; } vs.state = 0; break; default: /* Only numbers valid here */ if ((c >= '0') && (c <= '9')) { if (vs.state >= VSS_EPARAM) { vs.cy *= 10; vs.cy += c - '0'; } else { vs.cx *= 10; vs.cx += c - '0'; } } else vs.state = 0; break; } break; } } if (scroll) { scroll = 0; /* scroll check */ if (crtat >= Crtat + vs.nchr) { if (!kernel) { int s = spltty(); if (lock_state & SCROLL) tsleep((caddr_t)&lock_state, PUSER, "pcputc", 0); splx(s); } bcopy(Crtat + vs.ncol, Crtat, (vs.nchr - vs.ncol) * CHR); fillw((vs.at << 8) | ' ', Crtat + vs.nchr - vs.ncol, vs.ncol); crtat -= vs.ncol; } } } async_update(); } #define CODE_SIZE 4 /* Use a max of 4 for now... */ typedef struct { u_short type; char unshift[CODE_SIZE]; char shift[CODE_SIZE]; char ctl[CODE_SIZE]; char altgr[CODE_SIZE]; } Scan_def; static Scan_def us_scan_codes[] = { NONE, "", "", "", "", /* 0 unused */ ASCII, "\033", "\033", "\033", "", /* 1 ESCape */ ASCII, "1", "!", "!", "", /* 2 1 */ ASCII, "2", "@", "\000", "", /* 3 2 */ ASCII, "3", "#", "#", "", /* 4 3 */ ASCII, "4", "$", "$", "", /* 5 4 */ ASCII, "5", "%", "%", "", /* 6 5 */ ASCII, "6", "^", "\036", "", /* 7 6 */ ASCII, "7", "&", "&", "", /* 8 7 */ ASCII, "8", "*", "\010", "", /* 9 8 */ ASCII, "9", "(", "(", "", /* 10 9 */ ASCII, "0", ")", ")", "", /* 11 0 */ ASCII, "-", "_", "\037", "", /* 12 - */ ASCII, "=", "+", "+", "", /* 13 = */ ASCII, "\177", "\177", "\010", "", /* 14 backspace */ ASCII, "\t", "\177\t", "\t", "", /* 15 tab */ ASCII, "q", "Q", "\021", "", /* 16 q */ ASCII, "w", "W", "\027", "", /* 17 w */ ASCII, "e", "E", "\005", "", /* 18 e */ ASCII, "r", "R", "\022", "", /* 19 r */ ASCII, "t", "T", "\024", "", /* 20 t */ ASCII, "y", "Y", "\031", "", /* 21 y */ ASCII, "u", "U", "\025", "", /* 22 u */ ASCII, "i", "I", "\011", "", /* 23 i */ ASCII, "o", "O", "\017", "", /* 24 o */ ASCII, "p", "P", "\020", "", /* 25 p */ ASCII, "[", "{", "\033", "", /* 26 [ */ ASCII, "]", "}", "\035", "", /* 27 ] */ ASCII, "\r", "\r", "\n", "", /* 28 return */ CTL, "", "", "", "", /* 29 control */ ASCII, "a", "A", "\001", "", /* 30 a */ ASCII, "s", "S", "\023", "", /* 31 s */ ASCII, "d", "D", "\004", "", /* 32 d */ ASCII, "f", "F", "\006", "", /* 33 f */ ASCII, "g", "G", "\007", "", /* 34 g */ ASCII, "h", "H", "\010", "", /* 35 h */ ASCII, "j", "J", "\n", "", /* 36 j */ ASCII, "k", "K", "\013", "", /* 37 k */ ASCII, "l", "L", "\014", "", /* 38 l */ ASCII, ";", ":", ";", "", /* 39 ; */ ASCII, "'", "\"", "'", "", /* 40 ' */ ASCII, "`", "~", "`", "", /* 41 ` */ SHIFT, "", "", "", "", /* 42 shift */ ASCII, "\\", "|", "\034", "", /* 43 \ */ ASCII, "z", "Z", "\032", "", /* 44 z */ ASCII, "x", "X", "\030", "", /* 45 x */ ASCII, "c", "C", "\003", "", /* 46 c */ ASCII, "v", "V", "\026", "", /* 47 v */ ASCII, "b", "B", "\002", "", /* 48 b */ ASCII, "n", "N", "\016", "", /* 49 n */ ASCII, "m", "M", "\r", "", /* 50 m */ ASCII, ",", "<", "<", "", /* 51 , */ ASCII, ".", ">", ">", "", /* 52 . */ ASCII, "/", "?", "\037", "", /* 53 / */ SHIFT, "", "", "", "", /* 54 shift */ KP, "*", "*", "*", "", /* 55 kp * */ ALT, "", "", "", "", /* 56 alt */ ASCII, " ", " ", "\000", "", /* 57 space */ CAPS, "", "", "", "", /* 58 caps */ FUNC, "\033[M", "\033[Y", "\033[k", "", /* 59 f1 */ FUNC, "\033[N", "\033[Z", "\033[l", "", /* 60 f2 */ FUNC, "\033[O", "\033[a", "\033[m", "", /* 61 f3 */ FUNC, "\033[P", "\033[b", "\033[n", "", /* 62 f4 */ FUNC, "\033[Q", "\033[c", "\033[o", "", /* 63 f5 */ FUNC, "\033[R", "\033[d", "\033[p", "", /* 64 f6 */ FUNC, "\033[S", "\033[e", "\033[q", "", /* 65 f7 */ FUNC, "\033[T", "\033[f", "\033[r", "", /* 66 f8 */ FUNC, "\033[U", "\033[g", "\033[s", "", /* 67 f9 */ FUNC, "\033[V", "\033[h", "\033[t", "", /* 68 f10 */ NUM, "", "", "", "", /* 69 num lock */ SCROLL, "", "", "", "", /* 70 scroll lock */ KP, "7", "\033[H", "7", "", /* 71 kp 7 */ KP, "8", "\033[A", "8", "", /* 72 kp 8 */ KP, "9", "\033[I", "9", "", /* 73 kp 9 */ KP, "-", "-", "-", "", /* 74 kp - */ KP, "4", "\033[D", "4", "", /* 75 kp 4 */ KP, "5", "\033[E", "5", "", /* 76 kp 5 */ KP, "6", "\033[C", "6", "", /* 77 kp 6 */ KP, "+", "+", "+", "", /* 78 kp + */ KP, "1", "\033[F", "1", "", /* 79 kp 1 */ KP, "2", "\033[B", "2", "", /* 80 kp 2 */ KP, "3", "\033[G", "3", "", /* 81 kp 3 */ KP, "0", "\033[L", "0", "", /* 82 kp 0 */ KP, ".", "\177", ".", "", /* 83 kp . */ NONE, "", "", "", "", /* 84 0 */ NONE, "100", "", "", "", /* 85 0 */ NONE, "101", "", "", "", /* 86 0 */ FUNC, "\033[W", "\033[i", "\033[u", "", /* 87 f11 */ FUNC, "\033[X", "\033[j", "\033[v", "", /* 88 f12 */ NONE, "102", "", "", "", /* 89 0 */ NONE, "103", "", "", "", /* 90 0 */ NONE, "", "", "", "", /* 91 0 */ NONE, "", "", "", "", /* 92 0 */ NONE, "", "", "", "", /* 93 0 */ NONE, "", "", "", "", /* 94 0 */ NONE, "", "", "", "", /* 95 0 */ NONE, "", "", "", "", /* 96 0 */ NONE, "", "", "", "", /* 97 0 */ NONE, "", "", "", "", /* 98 0 */ NONE, "", "", "", "", /* 99 0 */ NONE, "", "", "", "", /* 100 */ NONE, "", "", "", "", /* 101 */ NONE, "", "", "", "", /* 102 */ NONE, "", "", "", "", /* 103 */ NONE, "", "", "", "", /* 104 */ NONE, "", "", "", "", /* 105 */ NONE, "", "", "", "", /* 106 */ NONE, "", "", "", "", /* 107 */ NONE, "", "", "", "", /* 108 */ NONE, "", "", "", "", /* 109 */ NONE, "", "", "", "", /* 110 */ NONE, "", "", "", "", /* 111 */ NONE, "", "", "", "", /* 112 */ NONE, "", "", "", "", /* 113 */ NONE, "", "", "", "", /* 114 */ NONE, "", "", "", "", /* 115 */ NONE, "", "", "", "", /* 116 */ NONE, "", "", "", "", /* 117 */ NONE, "", "", "", "", /* 118 */ NONE, "", "", "", "", /* 119 */ NONE, "", "", "", "", /* 120 */ NONE, "", "", "", "", /* 121 */ NONE, "", "", "", "", /* 122 */ NONE, "", "", "", "", /* 123 */ NONE, "", "", "", "", /* 124 */ NONE, "", "", "", "", /* 125 */ NONE, "", "", "", "", /* 126 */ NONE, "", "", "", "", /* 127 */ }; static Scan_def sw_scan_codes[] = { NONE, "", "", "", "", /* 0 unused */ ASCII, "\033", "\033", "\033", "\033", /* 1 ESCape */ ASCII, "1", "!", "", "0xa1", /* 2 1 */ ASCII, "2", "\"", "\000", "@", /* 3 2 */ ASCII, "3", "#", "", "0xa3", /* 4 3 */ ASCII, "4", "$", "", "$", /* 5 4 */ ASCII, "5", "%", "\034", "\\", /* 6 5 */ ASCII, "6", "&", "\034", "|", /* 7 6 */ ASCII, "7", "/", "\033", "{", /* 8 7 */ ASCII, "9", ")", "\035", "]", /* 10 9 */ ASCII, "0", "=", "\035", "}", /* 11 0 */ ASCII, "+", "?", "\037", "0xbf", /* 12 - */ ASCII, "\\", "`", "\034", "'", /* 13 = */ ASCII, "\177", "\177", "\010", "\177", /* 14 backspace */ ASCII, "\t", "\177\t", "\t", "\t", /* 15 tab */ ASCII, "q", "Q", "\021", "q", /* 16 q */ ASCII, "w", "W", "\027", "w", /* 17 w */ ASCII, "e", "E", "\005", "0xeb", /* 18 e */ ASCII, "r", "R", "\022", "r", /* 19 r */ ASCII, "t", "T", "\024", "t", /* 20 t */ ASCII, "y", "Y", "\031", "y", /* 21 y */ ASCII, "u", "U", "\025", "0xfc", /* 22 u */ ASCII, "i", "I", "\011", "i", /* 23 i */ ASCII, "o", "O", "\017", "0xf6", /* 24 o */ ASCII, "p", "P", "\020", "p", /* 25 p */ ASCII, "0xe5", "0xc5", "0xdc", "0xfc", /* 26 [ */ ASCII, "~", "^", "\036", "", /* 27 ] */ ASCII, "\r", "\r", "\n", "\r", /* 28 return */ CTL, "", "", "", "", /* 29 control */ ASCII, "a", "A", "\001", "0xe4", /* 30 a */ ASCII, "s", "S", "\023", "0xdf", /* 31 s */ ASCII, "d", "D", "\004", "d", /* 32 d */ ASCII, "f", "F", "\006", "f", /* 33 f */ ASCII, "g", "G", "\007", "g", /* 34 g */ ASCII, "h", "H", "\010", "h", /* 35 h */ ASCII, "j", "J", "\n", "j", /* 36 j */ ASCII, "k", "K", "\013", "k", /* 37 k */ ASCII, "l", "L", "\014", "l", /* 38 l */ ASCII, "0xf6", "0xd6", "0xd6", "0xf6", /* 39 ; */ ASCII, "0xe4", "0xc4", "0xc4", "0xe4", /* 40 ' */ ASCII, "|", "@", "\034", "0xa7", /* 41 ` */ SHIFT, "", "", "", "", /* 42 shift */ ASCII, "'", "*", "'", "'", /* 43 \ */ ASCII, "z", "Z", "\032", "z", /* 44 z */ ASCII, "x", "X", "\030", "x", /* 45 x */ ASCII, "c", "C", "\003", "c", /* 46 c */ ASCII, "v", "V", "\026", "v", /* 47 v */ ASCII, "b", "B", "\002", "b", /* 48 b */ ASCII, "n", "N", "\016", "n", /* 49 n */ ASCII, "m", "M", "\015", "m", /* 50 m */ ASCII, ",", ";", ",", ",", /* 51 , */ ASCII, ".", ":", ".", ".", /* 52 . */ ASCII, "-", "_", "\037", "-", /* 53 / */ SHIFT, "", "", "", "", /* 54 shift */ KP, "*", "*", "*", "*", /* 55 kp * */ ALT, "", "", "", "", /* 56 alt */ ASCII, " ", " ", "\000", " ", /* 57 space */ CAPS, "", "", "", "", /* 58 caps */ FUNC, "\033[M", "\033[Y", "\033[k", "", /* 59 f1 */ FUNC, "\033[N", "\033[Z", "\033[l", "", /* 60 f2 */ FUNC, "\033[O", "\033[a", "\033[m", "", /* 61 f3 */ FUNC, "\033[P", "\033[b", "\033[n", "", /* 62 f4 */ FUNC, "\033[Q", "\033[c", "\033[o", "", /* 63 f5 */ FUNC, "\033[R", "\033[d", "\033[p", "", /* 64 f6 */ FUNC, "\033[S", "\033[e", "\033[q", "", /* 65 f7 */ FUNC, "\033[T", "\033[f", "\033[r", "", /* 66 f8 */ FUNC, "\033[U", "\033[g", "\033[s", "", /* 67 f9 */ FUNC, "\033[V", "\033[h", "\033[t", "", /* 68 f10 */ NUM, "", "", "", "", /* 69 num lo SCROLL, "", "", "", "", /* 70 scroll KP, "7", "\033[H", "7", "", /* 71 kp 7 */ KP, "8", "\033[A", "8", "", /* 72 kp 8 */ KP, "9", "\033[I", "9", "", /* 73 kp 9 */ KP, "-", "-", "-", "", /* 74 kp - */ KP, "4", "\033[D", "4", "", /* 75 kp 4 */ KP, "5", "\033[E", "5", "", /* 76 kp 5 */ KP, "6", "\033[C", "6", "", /* 77 kp 6 */ KP, "+", "+", "+", "", /* 78 kp + */ KP, "1", "\033[F", "1", "", /* 79 kp 1 */ KP, "2", "\033[B", "2", "", /* 80 kp 2 */ KP, "3", "\033[G", "3", "", /* 81 kp 3 */ KP, "0", "\033[L", "0", "", /* 82 kp 0 */ KP, ".", "\177", ".", "", /* 83 kp . */ NONE, "", "", "", "", /* 84 0 */ NONE, "100", "", "", "", /* 85 0 */ ASCII, "<", ">", "0xbb", "0xab", /* 86 < > */ FUNC, "\033[W", "\033[i", "\033[u","", /* 87 f11 */ FUNC, "\033[X", "\033[j", "\033[v","", /* 88 f12 */ NONE, "102", "", "", "", /* 89 0 */ NONE, "103", "", "", "", /* 90 0 */ NONE, "", "", "", "", /* 91 0 */ NONE, "", "", "", "", /* 92 0 */ NONE, "", "", "", "", /* 93 0 */ NONE, "", "", "", "", /* 94 0 */ NONE, "", "", "", "", /* 95 0 */ NONE, "", "", "", "", /* 96 0 */ NONE, "", "", "", "", /* 97 0 */ NONE, "", "", "", "", /* 98 0 */ NONE, "", "", "", "", /* 99 0 */ NONE, "", "", "", "", /* 100 */ NONE, "", "", "", "", /* 101 */ NONE, "", "", "", "", /* 102 */ NONE, "", "", "", "", /* 103 */ NONE, "", "", "", "", /* 104 */ NONE, "", "", "", "", /* 105 */ NONE, "", "", "", "", /* 106 */ NONE, "", "", "", "", /* 107 */ NONE, "", "", "", "", /* 108 */ NONE, "", "", "", "", /* 109 */ NONE, "", "", "", "", /* 110 */ NONE, "", "", "", "", /* 111 */ NONE, "", "", "", "", /* 112 */ NONE, "", "", "", "", /* 113 */ NONE, "", "", "", "", /* 114 */ NONE, "", "", "", "", /* 115 */ NONE, "", "", "", "", /* 116 */ NONE, "", "", "", "", /* 117 */ NONE, "", "", "", "", /* 118 */ NONE, "", "", "", "", /* 119 */ NONE, "", "", "", "", /* 120 */ NONE, "", "", "", "", /* 121 */ NONE, "", "", "", "", /* 122 */ NONE, "", "", "", "", /* 123 */ NONE, "", "", "", "", /* 124 */ NONE, "", "", "", "", /* 125 */ NONE, "", "", "", "", /* 126 */ NONE, "", "", "", "", /* 127 */ }; /* * Get characters from the keyboard. If none are present, return NULL. */ Scan_def *scan_codes = us_scan_codes; char * sget() { u_char dt; static u_char extended = 0, shift_state = 0; static u_char capchar[2]; top: KBD_DELAY; dt = inb(KBDATAP); switch (dt) { case KBR_ACK: case KBR_ECHO: kb_oq_get = (kb_oq_get + 1) & 7; if(kb_oq_get != kb_oq_put) { outb(KBOUTP, kb_oq[kb_oq_get]); } goto loop; case KBR_RESEND: outb(KBOUTP, kb_oq[kb_oq_get]); goto loop; } if (pc_xmode > 0) { #if defined(DDB) && defined(XSERVER_DDB) /* F12 enters the debugger while in X mode */ if (dt == 88) Debugger(); #endif capchar[0] = dt; capchar[1] = 0; /* * Check for locking keys. * * XXX Setting the LEDs this way is a bit bogus. What if the * keyboard has been remapped in X? */ switch ((scan_codes+(dt & 0x7f))->type) { case NUM: if (dt & 0x80) { shift_state &= ~NUM; break; } if (shift_state & NUM) break; shift_state |= NUM; lock_state ^= NUM; async_update(); break; case CAPS: if (dt & 0x80) { shift_state &= ~CAPS; break; } if (shift_state & CAPS) break; shift_state |= CAPS; lock_state ^= CAPS; async_update(); break; case SCROLL: if (dt & 0x80) { shift_state &= ~SCROLL; break; } if (shift_state & SCROLL) break; shift_state |= SCROLL; lock_state ^= SCROLL; if ((lock_state & SCROLL) == 0) wakeup((caddr_t)&lock_state); async_update(); break; } return capchar; } switch (dt) { case KBR_EXTENDED: extended = 1; goto loop; } #ifdef DEBUG /* * Check for cntl-alt-esc. */ if ((dt == 1) && (shift_state & (CTL | ALT)) == (CTL | ALT)) { mdbpanic(); dt |= 0x80; /* discard esc (ddb discarded ctl-alt) */ } #endif /* * Check for make/break. */ if (dt & 0x80) { /* * break */ dt &= 0x7f; switch ((scan_codes+dt)->type) { case NUM: shift_state &= ~NUM; break; case CAPS: shift_state &= ~CAPS; break; case SCROLL: shift_state &= ~SCROLL; break; case SHIFT: shift_state &= ~SHIFT; break; case ALT: if (extended) shift_state &= ~ALTGR; else shift_state &= ~ALT; break; case CTL: shift_state &= ~CTL; break; } } else { /* * make */ switch ((scan_codes+dt)->type) { /* * locking keys */ case NUM: if (shift_state & NUM) break; shift_state |= NUM; lock_state ^= NUM; async_update(); break; case CAPS: if (shift_state & CAPS) break; shift_state |= CAPS; lock_state ^= CAPS; async_update(); break; case SCROLL: if (shift_state & SCROLL) break; shift_state |= SCROLL; lock_state ^= SCROLL; if ((lock_state & SCROLL) == 0) wakeup((caddr_t)&lock_state); async_update(); break; /* * non-locking keys */ case SHIFT: shift_state |= SHIFT; break; case ALT: if (extended) shift_state |= ALTGR; else shift_state |= ALT; break; case CTL: shift_state |= CTL; break; case ASCII: if (shift_state & ALTGR) { capchar[0] = (scan_codes+dt)->altgr[0]; if (shift_state & CTL) capchar[0] &= 0x1f; } else if (shift_state & CTL) capchar[0] = (scan_codes+dt)->ctl[0]; else if (shift_state & SHIFT) capchar[0] = (scan_codes+dt)->shift[0]; else capchar[0] = (scan_codes+dt)->unshift[0]; if ((lock_state & CAPS) && capchar[0] >= 'a' && capchar[0] <= 'z') { capchar[0] -= ('a' - 'A'); } capchar[0] |= (shift_state & ALT); extended = 0; return capchar; case NONE: printf("keycode %d\n",dt); break; case FUNC: { char *more_chars; if (shift_state & SHIFT) more_chars = (scan_codes+dt)->shift; else if (shift_state & CTL) more_chars = (scan_codes+dt)->ctl; else more_chars = (scan_codes+dt)->unshift; extended = 0; return more_chars; } case KP: { char *more_chars; if (shift_state & (SHIFT | CTL) || (lock_state & NUM) == 0 || extended) more_chars = (scan_codes+dt)->shift; else more_chars = (scan_codes+dt)->unshift; extended = 0; return more_chars; } } } extended = 0; loop: if ((inb(KBSTATP) & KBS_DIB) == 0) return 0; goto top; } int pcmmap(dev, offset, nprot) dev_t dev; int offset; int nprot; { if (offset >= 0xa0000 && offset < 0xc0000) return pica_btop(PICA_P_LOCAL_VIDEO + offset); if (offset >= 0x0000 && offset < 0x10000) return pica_btop(PICA_P_LOCAL_VIDEO_CTRL + offset); if (offset >= 0x40000000 && offset < 0x40800000) return pica_btop(PICA_P_LOCAL_VIDEO + offset - 0x40000000); return -1; } pc_xmode_on() { if (pc_xmode) return; pc_xmode = 1; #ifdef XFREE86_BUG_COMPAT /* If still unchanged, get current shape. */ if (cursor_shape == 0xffff) get_cursor_shape(); #endif } pc_xmode_off() { if (pc_xmode == 0) return; pc_xmode = 0; #ifdef XFREE86_BUG_COMPAT /* XXX It would be hard to justify why the X server doesn't do this. */ set_cursor_shape(); #endif async_update(); } /* $NetBSD: pms.c,v 1.21 1995/04/18 02:25:18 mycroft Exp $ */ #include /* status bits */ #define PMS_OBUF_FULL 0x01 #define PMS_IBUF_FULL 0x02 /* controller commands */ #define PMS_INT_ENABLE 0x47 /* enable controller interrupts */ #define PMS_INT_DISABLE 0x65 /* disable controller interrupts */ #define PMS_AUX_ENABLE 0xa7 /* enable auxiliary port */ #define PMS_AUX_DISABLE 0xa8 /* disable auxiliary port */ #define PMS_MAGIC_1 0xa9 /* XXX */ #define PMS_8042_CMD 0x65 /* mouse commands */ #define PMS_SET_SCALE11 0xe6 /* set scaling 1:1 */ #define PMS_SET_SCALE21 0xe7 /* set scaling 2:1 */ #define PMS_SET_RES 0xe8 /* set resolution */ #define PMS_GET_SCALE 0xe9 /* get scaling factor */ #define PMS_SET_STREAM 0xea /* set streaming mode */ #define PMS_SET_SAMPLE 0xf3 /* set sampling rate */ #define PMS_DEV_ENABLE 0xf4 /* mouse on */ #define PMS_DEV_DISABLE 0xf5 /* mouse off */ #define PMS_RESET 0xff /* reset */ #define PMS_CHUNK 128 /* chunk size for read */ #define PMS_BSIZE 1020 /* buffer size */ static inline void pms_dev_cmd(value) u_char value; { kbd_flush_input(); outb(KBCMDP, 0xd4); kbd_flush_input(); outb(KBDATAP, value); } static inline void pms_aux_cmd(value) u_char value; { kbd_flush_input(); outb(KBCMDP, value); } static inline void pms_pit_cmd(value) u_char value; { kbd_flush_input(); outb(KBCMDP, 0x60); kbd_flush_input(); outb(KBDATAP, value); } int pmsprobe(parent, match, aux) struct device *parent; void *match, *aux; { struct confargs *ca = aux; u_char x; /* Make shure we're looking for this type of device */ if(!BUS_MATCHNAME(ca, "pms")) return(0); pms_dev_cmd(KBC_RESET); pms_aux_cmd(PMS_MAGIC_1); delay(10000); x = inb(KBDATAP); pms_pit_cmd(PMS_INT_DISABLE); if (x & 0x04) return 0; return 1; } void pmsattach(parent, self, aux) struct device *parent, *self; void *aux; { struct pms_softc *sc = (void *)self; struct confargs *ca = aux; printf("\n"); /* Other initialization was done by pmsprobe. */ sc->sc_state = 0; BUS_INTR_ESTABLISH(ca, pmsintr, (void *)(long)sc); } int pmsopen(dev, flag) dev_t dev; int flag; { int unit = PMSUNIT(dev); struct pms_softc *sc; if (unit >= pmscd.cd_ndevs) return ENXIO; sc = pmscd.cd_devs[unit]; if (!sc) return ENXIO; if (sc->sc_state & PMS_OPEN) return EBUSY; if (clalloc(&sc->sc_q, PMS_BSIZE, 0) == -1) return ENOMEM; sc->sc_state |= PMS_OPEN; sc->sc_status = 0; sc->sc_x = sc->sc_y = 0; /* Enable interrupts. */ pms_dev_cmd(PMS_DEV_ENABLE); pms_aux_cmd(PMS_AUX_ENABLE); pms_dev_cmd(PMS_SET_RES); pms_dev_cmd(3); /* 8 counts/mm */ pms_dev_cmd(PMS_SET_SCALE21); #if 0 pms_dev_cmd(PMS_SET_SAMPLE); pms_dev_cmd(100); /* 100 samples/sec */ pms_dev_cmd(PMS_SET_STREAM); #endif pms_pit_cmd(PMS_INT_ENABLE); return 0; } int pmsclose(dev, flag) dev_t dev; int flag; { struct pms_softc *sc = pmscd.cd_devs[PMSUNIT(dev)]; /* Disable interrupts. */ pms_dev_cmd(PMS_DEV_DISABLE); pms_pit_cmd(PMS_INT_DISABLE); pms_aux_cmd(PMS_AUX_DISABLE); sc->sc_state &= ~PMS_OPEN; clfree(&sc->sc_q); return 0; } int pmsread(dev, uio, flag) dev_t dev; struct uio *uio; int flag; { struct pms_softc *sc = pmscd.cd_devs[PMSUNIT(dev)]; int s; int error; size_t length; u_char buffer[PMS_CHUNK]; /* Block until mouse activity occured. */ s = spltty(); while (sc->sc_q.c_cc == 0) { if (flag & IO_NDELAY) { splx(s); return EWOULDBLOCK; } sc->sc_state |= PMS_ASLP; if (error = tsleep((caddr_t)sc, PZERO | PCATCH, "pmsrea", 0)) { sc->sc_state &= ~PMS_ASLP; splx(s); return error; } } splx(s); /* Transfer as many chunks as possible. */ while (sc->sc_q.c_cc > 0 && uio->uio_resid > 0) { length = min(sc->sc_q.c_cc, uio->uio_resid); if (length > sizeof(buffer)) length = sizeof(buffer); /* Remove a small chunk from the input queue. */ (void) q_to_b(&sc->sc_q, buffer, length); /* Copy the data to the user process. */ if (error = uiomove(buffer, length, uio)) break; } return error; } int pmsioctl(dev, cmd, addr, flag) dev_t dev; u_long cmd; caddr_t addr; int flag; { struct pms_softc *sc = pmscd.cd_devs[PMSUNIT(dev)]; struct mouseinfo info; int s; int error; switch (cmd) { case MOUSEIOCREAD: s = spltty(); info.status = sc->sc_status; if (sc->sc_x || sc->sc_y) info.status |= MOVEMENT; if (sc->sc_x > 127) info.xmotion = 127; else if (sc->sc_x < -127) /* Bounding at -127 avoids a bug in XFree86. */ info.xmotion = -127; else info.xmotion = sc->sc_x; if (sc->sc_y > 127) info.ymotion = 127; else if (sc->sc_y < -127) info.ymotion = -127; else info.ymotion = sc->sc_y; /* Reset historical information. */ sc->sc_x = sc->sc_y = 0; sc->sc_status &= ~BUTCHNGMASK; ndflush(&sc->sc_q, sc->sc_q.c_cc); splx(s); error = copyout(&info, addr, sizeof(struct mouseinfo)); break; default: error = EINVAL; break; } return error; } /* Masks for the first byte of a packet */ #define PS2LBUTMASK 0x01 #define PS2RBUTMASK 0x02 #define PS2MBUTMASK 0x04 int pmsintr(arg) void *arg; { struct pms_softc *sc = arg; static int state = 0; static u_char buttons; u_char changed; u_char mbutt; static char dx, dy; u_char buffer[5]; if ((sc->sc_state & PMS_OPEN) == 0) { /* Interrupts are not expected. Discard the byte. */ kbd_flush_input(); return 0; } switch (state) { case 0: buttons = inb(KBDATAP); if ((buttons & 0xc0) == 0) ++state; break; case 1: dx = inb(KBDATAP); /* Bounding at -127 avoids a bug in XFree86. */ dx = (dx == -128) ? -127 : dx; ++state; break; case 2: dy = inb(KBDATAP); dy = (dy == -128) ? -127 : dy; state = 0; mbutt = buttons; buttons = ((buttons & PS2LBUTMASK) << 2) | ((buttons & (PS2RBUTMASK | PS2MBUTMASK)) >> 1); changed = ((buttons ^ sc->sc_status) & BUTSTATMASK) << 3; sc->sc_status = buttons | (sc->sc_status & ~BUTSTATMASK) | changed; if (dx || dy || changed) { /* Update accumulated movements. */ sc->sc_x += dx; sc->sc_y += dy; /* Add this event to the queue. */ buffer[0] = 0x80 | (mbutt & BUTSTATMASK); if(dx < 0) buffer[0] |= 0x10; buffer[1] = dx & 0x7f; if(dy < 0) buffer[0] |= 0x20; buffer[2] = dy & 0x7f; buffer[3] = buffer[4] = 0; (void) b_to_q(buffer, sizeof buffer, &sc->sc_q); if (sc->sc_state & PMS_ASLP) { sc->sc_state &= ~PMS_ASLP; wakeup((caddr_t)sc); } selwakeup(&sc->sc_rsel); } break; } return -1; } int pmsselect(dev, rw, p) dev_t dev; int rw; struct proc *p; { struct pms_softc *sc = pmscd.cd_devs[PMSUNIT(dev)]; int s; int ret; if (rw == FWRITE) return 0; s = spltty(); if (!sc->sc_q.c_cc) { selrecord(p, &sc->sc_rsel); ret = 0; } else ret = 1; splx(s); return ret; }