363 lines
10 KiB
C
363 lines
10 KiB
C
/* 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
|
|
* $Id: kbd.c,v 1.2 1994/02/15 15:10:22 mycroft Exp $
|
|
*/
|
|
|
|
#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;
|
|
}
|