Source to arch/i386/netboot/kbd.c


Enter a symbol's name here to quickly find it.

/* netboot
 *
 * kbd.c,v
 * Revision 1.1  1993/07/08  16:04:00  brezak
 * Diskless boot prom code from Jim McKim ([email protected])
 *
 * Revision 1.2  1993/06/30  20:16:13  mckim
 * Clean up compiler error msg.
 *
 * Revision 1.1.1.1  1993/05/28  11:41:07  mckim
 * Initial version.
 *
 *
 * 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;
}