diff options
Diffstat (limited to 'sys/arch/i386/netboot/kbd.c')
-rw-r--r-- | sys/arch/i386/netboot/kbd.c | 363 |
1 files changed, 363 insertions, 0 deletions
diff --git a/sys/arch/i386/netboot/kbd.c b/sys/arch/i386/netboot/kbd.c new file mode 100644 index 00000000000..6b6f33e1662 --- /dev/null +++ b/sys/arch/i386/netboot/kbd.c @@ -0,0 +1,363 @@ +/* $NetBSD: kbd.c,v 1.3 1994/10/27 04:21:15 cgd Exp $ */ + +/* netboot + * + * source in this file came from + * the original 386BSD boot blocks. + * + * 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. + * + * 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. + * + * @(#)kbd.c 7.4 (Berkeley) 5/4/91 + */ + +#include "proto.h" + +#define KBSTATP 0x64 /* kbd status port */ +#define KBS_INP_BUF_FUL 0x02 /* kbd char ready */ +#define KBDATAP 0x60 /* kbd data port */ + +#define K_RDWR 0x60 /* keyboard data & cmds (read/write) */ +#define K_STATUS 0x64 /* keyboard status */ +#define K_CMD 0x64 /* keybd ctlr command (write-only) */ + +#define K_OBUF_FUL 0x01 /* output buffer full */ +#define K_IBUF_FUL 0x02 /* input buffer full */ + +#define KC_CMD_WIN 0xd0 /* read output port */ +#define KC_CMD_WOUT 0xd1 /* write output port */ +#define KB_A20 0x9f /* enable A20, + enable output buffer full interrupt + enable data line + disable clock line */ + +#define L 0x01 /* locking function */ +#define SHF 0x02 /* keyboard shift */ +#define ALT 0x04 /* alternate shift -- alternate chars */ +#define NUM 0x08 /* numeric shift cursors vs. numeric */ +#define CTL 0x10 /* control shift -- allows ctl function */ +#define CPS 0x20 /* caps shift -- swaps case of letter */ +#define ASCII 0x40 /* ascii code for this key */ +#define STP 0x80 /* stop output */ + +static u_char action[128] = { +0, ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, /* scan 0- 7 */ +ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, /* scan 8-15 */ +ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, /* scan 16-23 */ +ASCII, ASCII, ASCII, ASCII, ASCII, CTL, ASCII, ASCII, /* scan 24-31 */ +ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, /* scan 32-39 */ +ASCII, ASCII, SHF , ASCII, ASCII, ASCII, ASCII, ASCII, /* scan 40-47 */ +ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, SHF, ASCII, /* scan 48-55 */ + ALT, ASCII, CPS|L, 0, 0, ASCII, 0, 0, /* scan 56-63 */ + 0, 0, 0, 0, 0, NUM|L, STP|L, ASCII, /* scan 64-71 */ +ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, ASCII, /* scan 72-79 */ +ASCII, ASCII, ASCII, ASCII, 0, 0, 0, 0, /* scan 80-87 */ +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, 0,0,0,0,0,0,0,0, } ; + +static u_char unshift[128] = { /* no shift */ +0, 033 , '1' , '2' , '3' , '4' , '5' , '6' , /* scan 0- 7 */ +'7' , '8' , '9' , '0' , '-' , '=' , 0177 ,'\t' , /* scan 8-15 */ + +'q' , 'w' , 'e' , 'r' , 't' , 'y' , 'u' , 'i' , /* scan 16-23 */ +'o' , 'p' , '[' , ']' , '\r' , CTL , 'a' , 's' , /* scan 24-31 */ + +'d' , 'f' , 'g' , 'h' , 'j' , 'k' , 'l' , ';' , /* scan 32-39 */ +'\'' , '`' , SHF , '\\' , 'z' , 'x' , 'c' , 'v' , /* scan 40-47 */ + +'b' , 'n' , 'm' , ',' , '.' , '/' , SHF , '*', /* scan 48-55 */ +ALT , ' ' , CPS|L, 0, 0, ' ' , 0, 0, /* scan 56-63 */ + + 0, 0, 0, 0, 0, NUM|L, STP|L, '7', /* scan 64-71 */ + '8', '9', '-', '4', '5', '6', '+', '1', /* scan 72-79 */ + + '2', '3', '0', '.', 0, 0, 0, 0, /* scan 80-87 */ +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, 0,0,0,0,0,0,0,0, } ; + +static u_char shift[128] = { /* shift shift */ +0, 033 , '!' , '@' , '#' , '$' , '%' , '^' , /* scan 0- 7 */ +'&' , '*' , '(' , ')' , '_' , '+' , 0177 ,'\t' , /* scan 8-15 */ +'Q' , 'W' , 'E' , 'R' , 'T' , 'Y' , 'U' , 'I' , /* scan 16-23 */ +'O' , 'P' , '[' , ']' , '\r' , CTL , 'A' , 'S' , /* scan 24-31 */ +'D' , 'F' , 'G' , 'H' , 'J' , 'K' , 'L' , ':' , /* scan 32-39 */ +'"' , '~' , SHF , '|' , 'Z' , 'X' , 'C' , 'V' , /* scan 40-47 */ +'B' , 'N' , 'M' , '<' , '>' , '?' , SHF , '*', /* scan 48-55 */ +ALT , ' ' , CPS|L, 0, 0, ' ' , 0, 0, /* scan 56-63 */ + 0, 0, 0, 0, 0, NUM|L, STP|L, '7', /* scan 64-71 */ + '8', '9', '-', '4', '5', '6', '+', '1', /* scan 72-79 */ + '2', '3', '0', '.', 0, 0, 0, 0, /* scan 80-87 */ +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, 0,0,0,0,0,0,0,0, } ; + +static u_char ctl[128] = { /* CTL shift */ +0, 033 , '!' , 000 , '#' , '$' , '%' , 036 , /* scan 0- 7 */ +'&' , '*' , '(' , ')' , 037 , '+' , 034 ,'\177', /* scan 8-15 */ +021 , 027 , 005 , 022 , 024 , 031 , 025 , 011 , /* scan 16-23 */ +017 , 020 , 033 , 035 , '\r' , CTL , 001 , 013 , /* scan 24-31 */ +004 , 006 , 007 , 010 , 012 , 013 , 014 , ';' , /* scan 32-39 */ +'\'' , '`' , SHF , 034 , 032 , 030 , 003 , 026 , /* scan 40-47 */ +002 , 016 , 015 , '<' , '>' , '?' , SHF , '*', /* scan 48-55 */ +ALT , ' ' , CPS|L, 0, 0, ' ' , 0, 0, /* scan 56-63 */ +CPS|L, 0, 0, 0, 0, 0, 0, 0, /* scan 64-71 */ + 0, 0, 0, 0, 0, 0, 0, 0, /* scan 72-79 */ + 0, 0, 0, 0, 0, 0, 0, 0, /* scan 80-87 */ + 0, 0, 033, '7' , '4' , '1' , 0, NUM|L, /* scan 88-95 */ +'8' , '5' , '2' , 0, STP|L, '9' , '6' , '3' , /*scan 96-103*/ +'.' , 0, '*' , '-' , '+' , 0, 0, 0, /*scan 104-111*/ +0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, } ; + +static u_char shfts, ctls, alts, caps, num, stp; +static u_char chr; +static int is_chr_queued = 0; + +static int +ProcessKbdEvent(void) { + /* Returns 1 if event result is an ascii char, 0 otherwise (or no event). + * As a side effect, it digests keyboard events and queues bona fide + * characters for subsequent reading. + */ + u_char dt, brk, act; + if ((inb(KBSTATP) & 0x01) == 0) + return is_chr_queued; + dt = inb(KBDATAP); + brk = dt & 0x80; + dt = dt & 0x7f; + + act = action[dt]; + if (act & SHF) { + if (brk) + shfts = 0; + else + shfts = 1; + } + if (act & ALT) { + if (brk) + alts = 0; + else + alts = 1; + } + if (act & NUM) { + if (act & L) { + if (!brk) + num ^= 1; + } else + if(brk) + num = 0; + else + num = 1; + } + if (act & CTL) { + if (brk) + ctls = 0; + else + ctls = 1; + } + if (act & CPS) { + if (act & L) { + if (!brk) + caps ^= 1; + } else + if (brk) + caps = 0; + else + caps = 1; + } + if (act & STP) { + if (act & L) { + if (!brk) + stp ^= 1; + } else + if (brk) + stp = 0; + else + stp = 1; + } + if (ctls && alts && dt == 83) + exit(1); + if ((act & ASCII) && !brk) { + if (shfts) { + chr = shift[dt]; + } else { + if (ctls) { + chr = ctl[dt]; + } else { + chr = unshift[dt]; + } + } + if (caps && (chr >= 'a' && chr <= 'z')) { + chr -= 'a' - 'A' ; + } + is_chr_queued = 1; + } + return is_chr_queued; +} + +int +IsKbdCharReady(void) { +#ifdef USE_BIOS + int result; + asm(" + push %%ebx + call _prot_to_real + mov $1, %%ax + int $0x16 + setz %%bl + .byte 0x66 + call _real_to_prot + movsbl %%bl, %0 + pop %%ebx + " : "=g" (result)); + return result; +#else + return ProcessKbdEvent(); +#endif +} + +static int +scankbd(void) { + +#ifdef notdef + u_char c; + c = inb(KBDATAP); + if (c == 83) exit(); + /*if (c == 0xaa) return (0); + if (c == 0xfa) return (0);*/ + + if (bdt == 0) { bdt = c&0x7f; return(0); } + + if(odt) return(1); + + c &= 0x7f; + + if (bdt == c) return(0); + odt = c; +#endif + return 1; +} + +static void +kbdreset(void) { + u_char c; + + /* Enable interrupts and keyboard controller */ + while (inb(KBSTATP)&2); outb(KBSTATP,0x60); + while (inb(KBSTATP)&2); outb(KBDATAP,0x4D); + + /* Start keyboard stuff RESET */ + while (inb(KBSTATP)&2); /* wait input ready */ + outb(KBDATAP,0xFF); /* RESET */ + + while((c=inb(KBDATAP))!=0xFA) ; + + /* While we are here, defeat gatea20 */ + while (inb(KBSTATP)&2); /* wait input ready */ + outb(KBSTATP,0xd1); + while (inb(KBSTATP)&2); /* wait input ready */ + outb(KBDATAP,0xdf); + while (inb(KBSTATP)&2); /* wait input ready */ + inb(KBDATAP); +} + +/* TBD - what does this do?, used by ResetCpu() */ +void +KbdWait(int n) { + int v; + + v = 0; + while(n-- && (v = scankbd()) == 0); + if (v) kbdreset(); +} + +/* + * Gate A20 for high memory + */ +u_char x_20 = KB_A20; + +void +gateA20(void) { + while (inb(K_STATUS) & K_IBUF_FUL); + while (inb(K_STATUS) & K_OBUF_FUL) + (void)inb(K_RDWR); + + outb(K_CMD, KC_CMD_WOUT); + while (inb(K_STATUS) & K_IBUF_FUL); + outb(K_RDWR, x_20); + while (inb(K_STATUS) & K_IBUF_FUL); +} + +int +getc(void) { +#ifdef USE_BIOS + int rslt; + asm(" + push %%ebx + call _prot_to_real + movb $0x0, %%ah + sti + int $0x16 + cli + movb %%al, %%bl + .byte 0x66 + call _real_to_prot + xor %%eax, %%eax + movb %%bl, %0 + pop %%ebx + " : "=g" (rslt)); + return rslt; +#else + while (!is_chr_queued) { + ProcessKbdEvent(); + } + is_chr_queued = 0; + return chr; +#endif +} + +int +getchar(void) { + int c; + + if ((c=getc()) == '\r') + c = '\n'; + if (c == '\b') { + putchar('\b'); + putchar(' '); + } + putchar(c); + return c; +} |