freebsd-dev/sys/isa/syscons.c

/*-
 * 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.
 *
 * 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.
 *
 *	from: @(#)pccons.c	5.11 (Berkeley) 5/21/91
 *	from: @(#)syscons.c	1.0 930928
 *	$Id: syscons.c,v 1.13 1993/10/16 13:46:23 rgrimes Exp $
 *
 * Heavily modified by S<EFBFBD>ren Schmidt (sos@login.dkuug.dk) to provide:
 *
 * 	virtual consoles, SYSV ioctl's, ANSI emulation 
 */

#define STAR_SAVER
/* #define FAT_CURSOR	/* This breaks on some CGA displays */

#include "param.h"
#include "conf.h"
#include "ioctl.h"
#include "proc.h"
#include "user.h"
#include "tty.h"
#include "uio.h"
#include "callout.h"
#include "systm.h"
#include "kernel.h"
#include "syslog.h"
#include "errno.h"
#include "machine/console.h"
#include "malloc.h"
#include "i386/isa/icu.h"
#include "i386/isa/isa.h"
#include "i386/isa/isa_device.h"
#include "machine/pc/display.h"
#include "i386/i386/cons.h"
#include "machine/psl.h"
#include "machine/frame.h"
#include "sc.h"
#include "ddb.h"
#include "iso8859.font"
#include "kbdtables.h"

#if NSC > 0
#ifndef NCONS
#define NCONS 12
#endif

/* status flags */
#define LOCK_KEY_MASK	0x0000F
#define LED_MASK	0x00007
#define UNKNOWN_MODE	0x00010
#define KBD_RAW_MODE	0x00020
#define SWITCH_WAIT_REL	0x00040
#define SWITCH_WAIT_ACQ	0x00080

/* virtual video memory addresses */
#define	MONO_BUF	(KERNBASE + 0xB0000)
#define	CGA_BUF		(KERNBASE + 0xB8000)
#define	VGA_BUF		(KERNBASE + 0xA0000)
#define VIDEOMEM	0x000A0000
#define MEMSIZE		0x00020000

/* misc defines */
#define MAX_ESC_PAR 	3
#define TEXT80x25	1
#define TEXT80x50	2
#define	COL		80
#define	ROW		25
#ifndef XTALSPEED
#define XTALSPEED	1193182			/* should be in isa.h */
#endif

/* defines related to hardware addresses */
#define	MONO_BASE	0x3B4			/* crt controller base mono */
#define	COLOR_BASE	0x3D4			/* crt controller base color */
#define ATC		IO_VGA+0x00		/* attribute controller */
#define TSIDX		IO_VGA+0x04		/* timing sequencer idx */
#define TSREG		IO_VGA+0x05		/* timing sequencer data */
#define PIXMASK		IO_VGA+0x06		/* pixel write mask */
#define PALRADR		IO_VGA+0x07		/* palette read address */
#define PALWADR		IO_VGA+0x08		/* palette write address */
#define PALDATA		IO_VGA+0x09		/* palette data register */
#define GDCIDX		IO_VGA+0x0E		/* graph data controller idx */
#define GDCREG		IO_VGA+0x0F		/* graph data controller data */

typedef struct term_stat {
	int 		esc;			/* processing escape sequence */
	int 		n_par;			/* # of parameters to ESC */
	int	 	last_par;		/* last parameter # */
	int 		par[MAX_ESC_PAR];	/* contains ESC parameters */
	int 		attr;			/* current attributes */
	int 		std_attr;		/* normal attributes */
	int 		rev_attr;		/* reverse attributes */
} term_stat;

typedef struct scr_stat {
	u_short 	*crt_base;		/* address of screen memory */
	u_short 	*scr;			/* buffer when off screen */
	u_short 	*crtat;			/* cursor address */
	int 		posx;			/* current X position */
	int 		posy;			/* current Y position */
	int 		max_posx;		/* X size */
	int 		max_posy;		/* X size */
	term_stat 	term;			/* terminal emulation stuff */
	char		cursor_start;		/* cursor start line # */
	char		cursor_end;		/* cursor start end # */
	u_char		border;			/* border color */
	u_short		bell_duration;
	u_short		bell_pitch;
	u_short 	status;			/* status (bitfield) */
	u_short 	mode;			/* mode */
	pid_t 		pid;			/* pid of controlling proc */
	struct proc 	*proc;			/* proc* of controlling proc */
	struct vt_mode 	smode;			/* switch mode */
} scr_stat;

typedef struct default_attr {
	int             std_attr;               /* normal attributes */
	int 		rev_attr;		/* reverse attributes */
} default_attr;

static default_attr user_default = {
	(FG_LIGHTGREY | BG_BLACK) << 8,
	(FG_BLACK | BG_LIGHTGREY) << 8
};

static default_attr kernel_default = {
	(FG_WHITE | BG_BLACK) << 8,
	(FG_BLACK | BG_LIGHTGREY) << 8
};

static default_attr *current_default;

static	scr_stat	cons_scr_stat[NCONS];
static	scr_stat	*cur_scr_stat = &cons_scr_stat[0];
static	scr_stat 	*new_scp, *old_scp;
static	term_stat	kernel_console; 
static	int		switch_in_progress = 0;

u_short			*Crtat = (u_short *)MONO_BUF;
static 	u_short	 	*crtat = 0;
static	u_int		crtc_addr = MONO_BASE;
static	char		crtc_vga = 0;
static 	u_char		shfts = 0, ctls = 0, alts = 0, agrs = 0;
static 	u_char		nlkcnt = 0, clkcnt = 0, slkcnt = 0, alkcnt = 0;
static	char		palette[3*256];
static 	const u_int 	n_fkey_tab = sizeof(fkey_tab) / sizeof(*fkey_tab);
static	int 		cur_cursor_pos = -1;
static	char 		in_putc, nx_scr;
static	char		saved_console = -1;	/* saved console number	*/
static	long		scrn_blank_time = 0;	/* screen saver timout value */
static	int		scrn_blanked = 0;	/* screen saver active flag */
static	long 		scrn_time_stamp;
static  u_char		scr_map[256];

struct	tty 		pccons[NCONS];
struct	tty 		*cur_pccons = &pccons[0];
struct  tty		*new_pccons;

extern	int hz;
extern	struct timeval time;

#define	CSF_ACTIVE	0x1			/* timeout active */
#define	CSF_POLLING	0x2			/* polling for input */

struct	pcconsoftc {
	char		cs_flags;
	char		cs_lastc;		/* last char sent */
	int		cs_timo;		/* timeouts since interrupt */
	u_long		cs_wedgecnt;		/* times restarted */
} pcconsoftc = {0, 0, 0, 0};


/* special characters */
#define bs	8
#define lf	10	
#define cr	13	
#define cntlc	3	
#define del	0177	
#define cntld	4

/* function prototypes */
int pcprobe(struct isa_device *dev);
int pcattach(struct isa_device *dev);
int pcopen(dev_t dev, int flag, int mode, struct proc *p);
int pcclose(dev_t dev, int flag, int mode, struct proc *p);
int pcread(dev_t dev, struct uio *uio, int flag);
int pcwrite(dev_t dev, struct uio *uio, int flag);
int pcparam(struct tty *tp, struct termios *t);
int pcioctl(dev_t dev, int cmd, caddr_t data, int flag, struct proc *p);
int pcxint(dev_t dev);
int pcstart(struct tty *tp);
int pccnprobe(struct consdev *cp);
int pccninit(struct consdev *cp);
int pccnputc(dev_t dev, char c);
int pccngetc(dev_t dev);
int scintr(dev_t dev, int irq, int cpl);
void scrn_saver(int test);
static struct tty *get_pccons(dev_t dev);
static scr_stat *get_scr_stat(dev_t dev);
static int get_scr_num(scr_stat *scp);
static void cursor_shape(int start, int end);
static void get_cursor_shape(int *start, int *end);
static void cursor_pos(void);
static void clear_screen(scr_stat *scp);
static switch_scr(u_int next_scr);
static void exchange_scr(void);
static void move_crsr(scr_stat *scp, int x, int y);
static void move_up(u_short *s, u_short *d, u_int len);
static void move_down(u_short *s, u_short *d, u_int len);
static void scan_esc(scr_stat *scp, u_char c);
static void ansi_put(scr_stat *scp, u_char c);
void consinit(void);
static void sput(u_char c);
static u_char *get_fstr(u_int c, u_int *len);
static update_leds(int which);
void reset_cpu(void);
u_int sgetc(int noblock);
int pcmmap(dev_t dev, int offset, int nprot);
int getchar(void);
static void kbd_wait(void);
static void kbd_cmd(u_char command);
static void set_mode(scr_stat *scp);
static void set_border(int color);
static load_font(int segment, int size, char* font);
static void save_palette(void);
static void load_palette(void);
static change_winsize(struct tty *tp, int x, int y);

struct	isa_driver scdriver = {
	pcprobe, pcattach, "sc",
};


int pcprobe(struct isa_device *dev)
{
	u_char c;
	int again = 0;

	/* Enable interrupts and keyboard controller */
	kbd_wait();
	outb(KB_STAT, KB_WRITE);
	kbd_cmd(0x4D);

	/* Start keyboard stuff RESET */
	kbd_cmd(KB_RESET);
	while ((c=inb(KB_DATA)) != KB_ACK) {
		if ((c == 0xFE) || (c == 0xFF)) {
			if (!again)
				printf("KEYBOARD disconnected: RECONNECT \n");
			kbd_cmd(KB_RESET);
			again = 1;
		}
	}
	kbd_wait();
	return (IO_KBDSIZE);
}


int pcattach(struct isa_device *dev)
{
	scr_stat *scp;
	int start = -1, end = -1, i;

	if (crtc_vga)
		if (crtc_addr == MONO_BASE)
			printf("VGA mono");
		else	
			printf("VGA color");
	else
		if (crtc_addr == MONO_BASE)
			printf("MDA/hercules");
		else	
			printf("CGA/EGA");

	if (NCONS > 1) 
		printf(" <%d virtual consoles>\n", NCONS);
	else
		printf("\n");
#ifdef	FAT_CURSOR
                start = 0;
                end = 18;
#endif
	if (crtc_vga) {
#ifndef	FAT_CURSOR
		get_cursor_shape(&start, &end);
#endif
		save_palette();
		load_font(0, 16, font_8x16);
		load_font(1, 8, font_8x8);
		load_font(2, 14, font_8x14);
	}
	current_default = &user_default;
	for (i = 0; i < NCONS; i++) {
		scp = &cons_scr_stat[i];
		scp->scr = (u_short *)malloc(COL * ROW * 2, M_DEVBUF, M_NOWAIT);
		scp->mode = TEXT80x25;
		scp->term.esc = 0;
		scp->term.std_attr = current_default->std_attr;
		scp->term.rev_attr = current_default->rev_attr;
		scp->term.attr = scp->term.std_attr;
		scp->border = BG_BLACK;
		scp->cursor_start = start;
		scp->cursor_end = end;
		scp->max_posx = COL;
		scp->max_posy = ROW;
		scp->bell_pitch = 800;
		scp->bell_duration = 10;
		scp->status = 0;
		scp->pid = 0;
		scp->proc = NULL;
		scp->smode.mode = VT_AUTO;
		if (i > 0) {
			scp->crt_base = scp->crtat = scp->scr;
			fillw(scp->term.attr|scr_map[0x20], scp->scr, COL*ROW);
		}
	}
	/* get cursor going */
#ifdef	FAT_CURSOR
        cursor_shape(cons_scr_stat[0].cursor_start,
                     cons_scr_stat[0].cursor_end);
#endif
	cursor_pos();
}


static struct tty *get_pccons(dev_t dev)
{
	int i = minor(dev);

	if (i >= NCONS)
		return(NULL);
	return(&pccons[i]);
}


static scr_stat *get_scr_stat(dev_t dev)
{
	int i = minor(dev);

	if (i >= NCONS)
		return(NULL);
	return(&cons_scr_stat[i]);
}


static int get_scr_num(scr_stat *scp)	/* allways call with legal scp !! */
{
	int i = 0;

	while ((i < NCONS) && (cur_scr_stat != &cons_scr_stat[i])) i++;
	return i;
}

pcopen(dev_t dev, int flag, int mode, struct proc *p)
{
	struct tty *tp = get_pccons(dev);

	if (!tp)
		return(ENXIO);
	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));
}


pcclose(dev_t dev, int flag, int mode, struct proc *p)
{
	struct tty *tp = get_pccons(dev);
	struct scr_stat *scp;

	if (!tp)
		return(ENXIO);
	scp = get_scr_stat(tp->t_dev);
	scp->pid = 0;
	scp->proc = NULL;
	scp->smode.mode = VT_AUTO;
	(*linesw[tp->t_line].l_close)(tp, flag);
	ttyclose(tp); 
	return(0);
}


pcread(dev_t dev, struct uio *uio, int flag)
{
	struct tty *tp = get_pccons(dev);

	if (!tp)
		return(ENXIO);
	return((*linesw[tp->t_line].l_read)(tp, uio, flag));
}


pcwrite(dev_t dev, struct uio *uio, int flag)
{
	struct tty *tp = get_pccons(dev);

	if (!tp)
		return(ENXIO);
	return((*linesw[tp->t_line].l_write)(tp, uio, flag));
}


/*
 * Got a console interrupt, keyboard action !
 * Catch the character, and see who it goes to.
 */
scintr(dev_t dev, int irq, int cpl)
{
	int c, len;
	u_char *cp;

	/* make screensaver happy */
	scrn_time_stamp = time.tv_sec;
	if (scrn_blanked)
		scrn_saver(0);
	c = sgetc(1);
	if (c & 0x100)
		return;
	if ((cur_pccons->t_state & TS_ISOPEN) == 0)
		return;
	if (pcconsoftc.cs_flags & CSF_POLLING)
		return;
	if (c < 0x100)
		(*linesw[cur_pccons->t_line].l_rint)(c & 0xFF, cur_pccons);
	else if (cp = get_fstr((u_int)c, (u_int *)&len)) {
		while (len-- >  0)
			(*linesw[cur_pccons->t_line].l_rint)
				(*cp++ & 0xFF, cur_pccons);
	}
}


/*
 * Set line parameters
 */
pcparam(struct tty *tp, struct termios *t)
{
	int cflag = t->c_cflag;

	/* and copy to tty */
	tp->t_ispeed = t->c_ispeed;
	tp->t_ospeed = t->c_ospeed;
	tp->t_cflag = cflag;
	return(0);
}


pcioctl(dev_t dev, int cmd, caddr_t data, int flag, struct proc *p)
{
	int i, error;
	struct tty *tp;
	struct syscframe *fp;
	scr_stat *scp; 

	tp = get_pccons(dev);
	if (!tp)
		return ENXIO;
	scp = get_scr_stat(tp->t_dev);

	switch (cmd) {	/* process console hardware related ioctl's */

	case CONS_BLANKTIME:	/* set screen saver timeout (0 = no saver) */
		scrn_blank_time = *(int*)data;
		return 0;

	case CONS_80x25TEXT:	/* set 80x25 text mode */
		if (!crtc_vga)
			return ENXIO;
		scp->mode = TEXT80x25;
		scp->max_posy = 25;
		free(scp->scr, M_DEVBUF); 
		scp->scr = (u_short *)malloc(scp->max_posx*scp->max_posy*2,
					     M_DEVBUF, M_NOWAIT);
		if (scp != cur_scr_stat)
			scp->crt_base = scp->scr;
		set_mode(scp);
		clear_screen(scp);
		change_winsize(tp, scp->max_posx, scp->max_posy); 
		return 0;

	case CONS_80x50TEXT:	/* set 80x50 text mode */
		if (!crtc_vga)
			return ENXIO;
		scp->mode = TEXT80x50;
		scp->max_posy = 50;
		free(scp->scr, M_DEVBUF); 
		scp->scr = (u_short *)malloc(scp->max_posx*scp->max_posy*2,
					     M_DEVBUF, M_NOWAIT);
		if (scp != cur_scr_stat)
			scp->crt_base = scp->scr;
		set_mode(scp);
		clear_screen(scp);
		change_winsize(tp, scp->max_posx, scp->max_posy); 
		return 0;

	case CONS_GETVERS:	/* get version number */
		*(int*)data = 0x100;	/* version 1.0 */
		return 0;

	case CONS_GETINFO:	/* get current (virtual) console info */
		if (*data == sizeof(struct vid_info)) {
			vid_info_t *ptr = (vid_info_t*)data;
			ptr->m_num = get_scr_num(scp);
			ptr->mv_col = scp->posx;
			ptr->mv_row = scp->posy;
			ptr->mv_csz = scp->max_posx;
			ptr->mv_rsz = scp->max_posy;
			ptr->mv_norm.fore = (scp->term.std_attr & 0x0f00)>>8;
			ptr->mv_norm.back = (scp->term.std_attr & 0xf000)>>12;
			ptr->mv_rev.fore = (scp->term.rev_attr & 0x0f00)>>8;
			ptr->mv_rev.back = (scp->term.rev_attr & 0xf000)>>12;
			ptr->mv_grfc.fore = 0;		/* not supported */
			ptr->mv_grfc.back = 0;		/* not supported */
			ptr->mv_ovscan = scp->border;
			ptr->mk_keylock = scp->status & LOCK_KEY_MASK;
			return 0;
		}
		return EINVAL;

	case VT_SETMODE:	/* set screen switcher mode */
		bcopy(data, &scp->smode, sizeof(struct vt_mode));
		if (scp->smode.mode == VT_PROCESS) {
			scp->proc = p;
			scp->pid = scp->proc->p_pid;
		}
		return 0;
	
	case VT_GETMODE:	/* get screen switcher mode */
		bcopy(&scp->smode, data, sizeof(struct vt_mode));
		return 0;
	
	case VT_RELDISP:	/* screen switcher ioctl */
		switch(*data) {
		case VT_FALSE:	/* user refuses to release screen, abort */
			if (scp == old_scp && (scp->status & SWITCH_WAIT_REL)) {
				old_scp->status &= ~SWITCH_WAIT_REL;
				switch_in_progress = 0;
				return 0;
			}
			return EINVAL;

		case VT_TRUE:	/* user has released screen, go on */
			if (scp == old_scp && (scp->status & SWITCH_WAIT_REL)) {
				scp->status &= ~SWITCH_WAIT_REL;
				exchange_scr();
				if (new_scp->smode.mode == VT_PROCESS) {
					new_scp->status |= SWITCH_WAIT_ACQ;
					psignal(new_scp->proc, 
						new_scp->smode.acqsig);
				}
				else 
					switch_in_progress = 0;
				return 0;
			}
			return EINVAL;

		case VT_ACKACQ:	/* acquire acknowledged, switch completed */
			if (scp == new_scp && (scp->status & SWITCH_WAIT_ACQ)) {
				scp->status &= ~SWITCH_WAIT_ACQ;
				switch_in_progress = 0;
				return 0;
			}
			return EINVAL;

		default:
			return EINVAL;
		}
		/* NOT REACHED */

	case VT_OPENQRY:	/* return free virtual console */
 		for (i = 0; i < NCONS; i++)
 			if (!(pccons[i].t_state & TS_ISOPEN)) {
 				*data = i + 1;
 				return 0;
 			}
 		return EINVAL;
		/* NOT REACHED */

	case VT_GETACTIVE:	/* return number of active virtual console */
		*data = get_scr_num(scp) + 1;
		return 0;

	case VT_ACTIVATE:	/* switch to screen *data */
		return switch_scr((*data) - 1);

	case VT_WAITACTIVE:	/* wait for switch to occur */
		if (*data > NCONS) 
			return EINVAL;
		if (minor(dev) == (*data) - 1) 
			return 0;
		if (*data == 0) {
			if (scp == cur_scr_stat)
				return 0;
			while ((error=tsleep(&scp->smode, 
					     PZERO|PCATCH, "waitvt", 0)) 
					     == ERESTART) ;
		}
		else 
			while ((error=tsleep(&cons_scr_stat[*data].smode, 
					     PZERO|PCATCH, "waitvt", 0)) 
					     == ERESTART) ;
		return error;

	case KDENABIO:		/* allow io operations */
	 	fp = (struct syscframe *)p->p_regs;
	 	fp->sf_eflags |= PSL_IOPL;
		return 0; 

	case KDDISABIO:		/* disallow io operations (default) */
	 	fp = (struct syscframe *)p->p_regs;
	 	fp->sf_eflags &= ~PSL_IOPL;
	 	return 0;

        case KDSETMODE:		/* set current mode of this (virtual) console */
		switch (*data) {
		case KD_TEXT:	/* switch to TEXT (known) mode */
				/* restore fonts & palette ! */
			if (crtc_vga) {
				load_font(0, 16, font_8x16);
				load_font(1, 8, font_8x8);
				load_font(2, 14, font_8x14);
				load_palette();
			}
			/* FALL THROUGH */

		case KD_TEXT1:	/* switch to TEXT (known) mode */
				/* no restore fonts & palette */
			scp->status &= ~UNKNOWN_MODE;
			set_mode(scp);
			clear_screen(scp);
			return 0;

		case KD_GRAPHICS:/* switch to GRAPHICS (unknown) mode */
			scp->status |= UNKNOWN_MODE;
			return 0;
		default:
			return EINVAL;
		}
		/* NOT REACHED */

	case KDGETMODE:		/* get current mode of this (virtual) console */
		*data = (scp->status & UNKNOWN_MODE) ? KD_GRAPHICS : KD_TEXT;
		return 0;

	case KDSBORDER:		/* set border color of this (virtual) console */
		if (!crtc_vga)
			return ENXIO;
		scp->border = *data;
		if (scp == cur_scr_stat) 
			set_border(scp->border);
		return 0;

	case KDSKBSTATE:	/* set keyboard state (locks) */
		if (*data >= 0 && *data <= LOCK_KEY_MASK) {
			scp->status &= ~LOCK_KEY_MASK;
			scp->status |= *data;
			if (scp == cur_scr_stat) 
				update_leds(scp->status & LED_MASK);
			return 0;
		}
		return EINVAL;

	case KDGKBSTATE:	/* get keyboard state (locks) */
		*data = scp->status & LOCK_KEY_MASK;
		return 0;

	case KDSETRAD:		/* set keyboard repeat & delay rates */
		if (*(u_char*)data < 0x80) {
			kbd_cmd(KB_SETRAD);
			kbd_cmd(*data & 0x7f);
			return 0;
		}
		return EINVAL;

	case KDSKBMODE:		/* set keyboard mode */
		switch (*data) {
		case K_RAW:	/* switch to RAW scancode mode */
			scp->status |= KBD_RAW_MODE;
			return 0;

		case K_XLATE:	/* switch to XLT ascii mode */
			scp->status &= ~KBD_RAW_MODE;
			return 0;
		default:
			return EINVAL;
		}
		/* NOT REACHED */

	case KDGKBMODE:		/* get keyboard mode */
		*data = (scp->status & KBD_RAW_MODE) ? K_RAW : K_XLATE;
		return 0;

	case KDMKTONE:		/* sound the bell */
		if (scp == cur_scr_stat)
			sysbeep(scp->bell_pitch, scp->bell_duration);
		return 0;

	case KIOCSOUND:		/* make tone (*data) hz */
		if (scp == cur_scr_stat) {
			if (*(int*)data) {
			int pitch = XTALSPEED/(*(int*)data);
				/* enable counter 2 */
				outb(0x61, inb(0x61) | 3);
				/* set command for counter 2, 2 byte write */
				outb(0x43, 0xb6);
				/* set pitch */
				outb(0x42, pitch);
				outb(0x42, (pitch>>8));
			}
			else {
				/* disable counter 2 */
				outb(0x61, inb(0x61) & 0xFC);
			}
		}
		return 0;

	case KDGKBTYPE:		/* get keyboard type */
		*data = 0;	/* type not known (yet) */
		return 0;

	case KDSETLED:		/* set keyboard LED status */
		if (*data >= 0 && *data <= LED_MASK) {
			scp->status &= ~LED_MASK;
			scp->status |= *data;
			if (scp == cur_scr_stat)
			update_leds(scp->status & LED_MASK);
			return 0;
		}
		return EINVAL;

	case KDGETLED:		/* get keyboard LED status */
		*data = scp->status & LED_MASK;
		return 0;

	case GETFKEY:		/* get functionkey string */
		if (*(u_short*)data < n_fkey_tab) {
		 	fkeyarg_t *ptr = (fkeyarg_t*)data;
			bcopy(&fkey_tab[ptr->keynum].str,
			      ptr->keydef,
			      fkey_tab[ptr->keynum].len);
			ptr->flen = fkey_tab[ptr->keynum].len;
			return 0;
		}
		else
			return EINVAL;

	case SETFKEY:		/* set functionkey string */
		if (*(u_short*)data < n_fkey_tab) {
		 	fkeyarg_t *ptr = (fkeyarg_t*)data;
			bcopy(ptr->keydef, 
			      &fkey_tab[ptr->keynum].str, 
			      min(ptr->flen, MAXFK));
			fkey_tab[ptr->keynum].len = min(ptr->flen, MAXFK);
			return 0;
		}
		else
			return EINVAL;

	case GIO_SCRNMAP: 	/* get output translation table */
		bcopy(&scr_map, data, sizeof(scr_map));
		return 0;

	case PIO_SCRNMAP:	/* set output translation table */
		bcopy(data, &scr_map, sizeof(scr_map));
		return 0;

	case GIO_KEYMAP: 	/* get keyboard translation table */
		bcopy(&key_map, data, sizeof(key_map));
		return 0;

	case PIO_KEYMAP:	/* set keyboard translation table */
		bcopy(data, &key_map, sizeof(key_map));
		return 0;

	case PIO_FONT8x8:	/* set 8x8 dot font */
		if (!crtc_vga)
			return ENXIO;
		bcopy(data, &font_8x8, sizeof(font_8x8));
		load_font(1, 8, font_8x8);
		return 0;

	case GIO_FONT8x8:	/* get 8x8 dot font */
		if (!crtc_vga)
			return ENXIO;
		bcopy(&font_8x8, data, sizeof(font_8x8));
		return 0;

	case PIO_FONT8x14:	/* set 8x14 dot font */
		if (!crtc_vga)
			return ENXIO;
		bcopy(data, &font_8x14, sizeof(font_8x14));
		load_font(2, 14, font_8x14);
		return 0;

	case GIO_FONT8x14:	/* get 8x14 dot font */
		if (!crtc_vga)
			return ENXIO;
		bcopy(&font_8x14, data, sizeof(font_8x14));
		return 0;

	case PIO_FONT8x16:	/* set 8x16 dot font */
		if (!crtc_vga)
			return ENXIO;
		bcopy(data, &font_8x16, sizeof(font_8x16));
		load_font(0, 16, font_8x16);
		return 0;

	case GIO_FONT8x16:	/* get 8x16 dot font */
		if (!crtc_vga)
			return ENXIO;
		bcopy(&font_8x16, data, sizeof(font_8x16));
		return 0;

	case CONSOLE_X_MODE_ON:	/* just to be compatible */
		if (saved_console < 0) {
			saved_console = get_scr_num(cur_scr_stat);
			switch_scr(minor(dev));
	 		fp = (struct syscframe *)p->p_regs;
	 		fp->sf_eflags |= PSL_IOPL;
			scp->status |= UNKNOWN_MODE;
			scp->status |= KBD_RAW_MODE;
			return 0;
		}
		return EAGAIN;

	case CONSOLE_X_MODE_OFF:/* just to be compatible */
	 	fp = (struct syscframe *)p->p_regs;
	 	fp->sf_eflags &= ~PSL_IOPL;
		if (crtc_vga) {
			load_font(0, 16, font_8x16);
			load_font(1, 8, font_8x8);
			load_font(2, 14, font_8x14);
			load_palette();
		}
		scp->status &= ~UNKNOWN_MODE;
		set_mode(scp);
		clear_screen(scp);
		scp->status &= ~KBD_RAW_MODE;
		switch_scr(saved_console);
		saved_console = -1;
		return 0;

	 case CONSOLE_X_BELL:	/* more compatibility */
                /*
                 * 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(XTALSPEED/((int*)data)[0], ((int*)data)[1]*hz/3000);
                else
		    sysbeep(0x31b, hz/4);
                return 0;

	default:
		break;
	}	
	
	error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag);
	if (error >= 0)
		return(error);
	error = ttioctl(tp, cmd, data, flag);
	if (error >= 0)
		return(error);
	return(ENOTTY);
}


pcxint(dev_t dev)
{
	pccons[minor(dev)].t_state &= ~TS_BUSY;
	pcconsoftc.cs_timo = 0;
	if (pccons[minor(dev)].t_line)
		(*linesw[pccons[minor(dev)].t_line].l_start)
			(&pccons[minor(dev)]);
	else
		pcstart(&pccons[minor(dev)]);
}


pcstart(struct tty *tp)
{
	int c, s;
	scr_stat *scp = get_scr_stat(tp->t_dev);

	s = spltty();
	if (!(tp->t_state & (TS_TIMEOUT|TS_BUSY|TS_TTSTOP)))
		for (;;) {
			if (RB_LEN(&tp->t_out) <= tp->t_lowat) {
				if (tp->t_state & TS_ASLEEP) {
					tp->t_state &= ~TS_ASLEEP;
					wakeup((caddr_t)&tp->t_out);
				}
				if (tp->t_wsel) {
					selwakeup(tp->t_wsel, 
						  tp->t_state & TS_WCOLL);
					tp->t_wsel = 0;
					tp->t_state &= ~TS_WCOLL;
				}
			}
			if (RB_LEN(&tp->t_out) == 0)
				break;
			if (scp->status & SLKED) 
				break;
			c = getc(&tp->t_out);
			tp->t_state |= TS_BUSY;
			splx(s);
			ansi_put(scp, c);
			s = spltty();
			tp->t_state &= ~TS_BUSY;
		}
	splx(s);
}


pccnprobe(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_tp = &pccons[0];
	cp->cn_pri = CN_INTERNAL;
}


pccninit(struct consdev *cp)
{
}


pccnputc(dev_t dev, char c)
{
	int pos;

	if (cur_scr_stat->status & UNKNOWN_MODE) 
		return;
	if (c == '\n')
		sput('\r');
	sput(c);
 	pos = cur_scr_stat->crtat - cur_scr_stat->crt_base;
	if (pos != cur_cursor_pos) {
		cur_cursor_pos = pos;
		outb(crtc_addr,14);
		outb(crtc_addr+1,pos >> 8);
		outb(crtc_addr,15);
		outb(crtc_addr+1,pos&0xff);
	}
}


pccngetc(dev_t dev)
{
	int c, s;

	s = spltty();		/* block scintr while we poll */
	c = sgetc(0);
	splx(s);
	if (c == '\r') c = '\n';
	return(c);
}

#if !defined(STAR_SAVER) && !defined(SNAKE_SAVER)

void scrn_saver(int test)
{
	u_char val;

	if (test) {
		scrn_blanked = 1;
  		outb(TSIDX, 0x01); val = inb(TSREG); 
		outb(TSIDX, 0x01); outb(TSREG, val | 0x20);
	}
	else {
		scrn_blanked = 0;
  		outb(TSIDX, 0x01); val = inb(TSREG); 
		outb(TSIDX, 0x01); outb(TSREG, val & 0xDF);
	}
}
#endif
#if defined(STAR_SAVER) || defined(SNAKE_SAVER)

static u_long 	rand_next = 1;

static rand()
{
	return ((rand_next = rand_next * 1103515245 + 12345) & 0x7FFFFFFF);
}
#endif
#ifdef STAR_SAVER
/*
 * Alternate saver that got its inspiration from a well known utility
 * package for an unfamous OS.
 */

#define NUM_STARS	50

void scrn_saver(int test)
{
	scr_stat	*scp = cur_scr_stat;
	int		cell, i;
	char 		pattern[] = {"...........++++***   "};
	char		colors[] = {FG_DARKGREY, FG_LIGHTGREY, 
				    FG_WHITE, FG_LIGHTCYAN};
	static u_short 	stars[NUM_STARS][2];
 
	if (test) {
		if (!scrn_blanked) {
			bcopy(Crtat, scp->scr, 
			      scp->max_posx * scp->max_posy * 2);
			fillw((FG_LIGHTGREY|BG_BLACK)<<8 | scr_map[0x20], Crtat, 
			      scp->max_posx * scp->max_posy);
			set_border(0);
			i = scp->max_posy * scp->max_posx + 5;
			outb(crtc_addr, 14);
			outb(crtc_addr+1, i >> 8);
			outb(crtc_addr, 15);
			outb(crtc_addr+1, i & 0xff);
			scrn_blanked = 1;
 			for(i=0; i<NUM_STARS; i++) {
  				stars[i][0] = 
					rand() % (scp->max_posx*scp->max_posy);
  				stars[i][1] = 0;
 			}
		}
   		cell = rand() % NUM_STARS;
		*((u_short*)(Crtat + stars[cell][0])) = 
			scr_map[pattern[stars[cell][1]]] | 
			        colors[rand()%sizeof(colors)] << 8;
		if ((stars[cell][1]+=(rand()%4)) >= sizeof(pattern)-1) {
    			stars[cell][0] = rand() % (scp->max_posx*scp->max_posy);
   			stars[cell][1] = 0;
		}
	}
	else {
		if (scrn_blanked) {
			bcopy(scp->scr, Crtat, scp->max_posx*scp->max_posy*2);
			cur_cursor_pos = -1;
			set_border(scp->border);
			scrn_blanked = 0;
		}
	}
}
#endif
#ifdef SNAKE_SAVER
/*
 * alternative screen saver for cards that do not like blanking
 */

void scrn_saver(int test)
{
	const char	saves[] = {"FreeBSD"};
	static u_char	*savs[sizeof(saves)-1];
	static int	dirx, diry;
	int		f;
	scr_stat	*scp = cur_scr_stat;

	if (test) {
		if (!scrn_blanked) {
			bcopy(Crtat, scp->scr, 
			      scp->max_posx * scp->max_posy * 2);
			fillw((FG_LIGHTGREY|BG_BLACK)<<8 | scr_map[0x20], Crtat, 
			      scp->max_posx * scp->max_posy);
			set_border(0);
			dirx = (scp->posx ? 1 : -1);
			diry = (scp->posy ? 
				scp->max_posx : -scp->max_posx);
			for (f=0; f< sizeof(saves)-1; f++)
				savs[f] = (u_char *)Crtat + 2 *
				          (scp->posx+scp->posy*scp->max_posx);
			*(savs[0]) = scr_map[*saves];
			f = scp->max_posy * scp->max_posx + 5;
			outb(crtc_addr, 14);
			outb(crtc_addr+1, f >> 8);
			outb(crtc_addr, 15);
			outb(crtc_addr+1, f & 0xff);
			scrn_blanked = 1;
		}
		if (scrn_blanked++ < 4) 
			return;
		scrn_blanked = 1;
		*(savs[sizeof(saves)-2]) = scr_map[0x20];
		for (f=sizeof(saves)-2; f > 0; f--)
			savs[f] = savs[f-1];
		f = (savs[0] - (u_char *)Crtat) / 2;
		if ((f % scp->max_posx) == 0 ||
		    (f % scp->max_posx) == scp->max_posx - 1 ||
		    (rand() % 50) == 0)
			dirx = -dirx;
		if ((f / scp->max_posx) == 0 || 
		    (f / scp->max_posx) == scp->max_posy - 1 ||
		    (rand() % 20) == 0)
			diry = -diry;
		savs[0] += 2*dirx + 2*diry;
		for (f=sizeof(saves)-2; f>=0; f--)
			*(savs[f]) = scr_map[saves[f]];
	}
	else {
		if (scrn_blanked) {
			bcopy(scp->scr, Crtat, 
			      scp->max_posx * scp->max_posy * 2);
			cur_cursor_pos = -1;
			set_border(scp->border);
			scrn_blanked = 0;
		}
	}
}
#endif

static void cursor_shape(int start, int end)
{
	outb(crtc_addr, 10);
	outb(crtc_addr+1, start & 0xFF);
	outb(crtc_addr, 11);
	outb(crtc_addr+1, end & 0xFF);
}


static void get_cursor_shape(int *start, int *end)
{
	outb(crtc_addr, 10);
	*start = inb(crtc_addr+1) & 0x1F;
	outb(crtc_addr, 11);
	*end = inb(crtc_addr+1) & 0x1F;
}


static void cursor_pos(void)
{
	int pos;

	if (cur_scr_stat->status & UNKNOWN_MODE) 
		return;
	if (scrn_blank_time && (time.tv_sec > scrn_time_stamp+scrn_blank_time))
		scrn_saver(1);
	pos = cur_scr_stat->crtat - cur_scr_stat->crt_base;
	if (!scrn_blanked && pos != cur_cursor_pos) {
		cur_cursor_pos = pos;
		outb(crtc_addr, 14);
		outb(crtc_addr+1, pos>>8);
		outb(crtc_addr, 15);
		outb(crtc_addr+1, pos&0xff);
	}
	timeout(cursor_pos, 0, hz/20);
}


static void clear_screen(scr_stat *scp)
{
	move_crsr(scp, 0, 0);
	fillw(scp->term.attr | scr_map[0x20], scp->crt_base,
	       scp->max_posx * scp->max_posy);
}


static switch_scr(u_int next_scr)
{
	if (in_putc) {		/* don't switch if in putc */
		nx_scr = next_scr+1;
		return 0;
	}
	if (switch_in_progress && 
	    (cur_scr_stat->proc != pfind(cur_scr_stat->pid)))
		switch_in_progress = 0;
	if (next_scr >= NCONS || switch_in_progress) {
		sysbeep(800, hz/4);
		return -1;
	}
	switch_in_progress = 1;
	old_scp = cur_scr_stat;
	new_scp = &cons_scr_stat[next_scr];
	wakeup(&new_scp->smode);
	if (new_scp == old_scp) {
		switch_in_progress = 0;
		return 0;
	}
	new_pccons = &pccons[next_scr];
	
	/* has controlling process died? */
	if (old_scp->proc && (old_scp->proc != pfind(old_scp->pid)))
		old_scp->smode.mode = VT_AUTO;
	if (new_scp->proc && (new_scp->proc != pfind(new_scp->pid)))
		new_scp->smode.mode = VT_AUTO;

	/* check the modes and switch approbiatly */
	if (old_scp->smode.mode == VT_PROCESS) {
		old_scp->status |= SWITCH_WAIT_REL;
		psignal(old_scp->proc, old_scp->smode.relsig);
	}
	else {
		exchange_scr();
		if (new_scp->smode.mode == VT_PROCESS) {
			new_scp->status |= SWITCH_WAIT_ACQ;
			psignal(new_scp->proc, new_scp->smode.acqsig);
		}
		else
			switch_in_progress = 0;
	}
	return 0;
}


static void exchange_scr(void) 
{
	bcopy(Crtat, old_scp->scr, old_scp->max_posx * old_scp->max_posy * 2);
	old_scp->crt_base = old_scp->scr;
	move_crsr(old_scp, old_scp->posx, old_scp->posy);
	cur_scr_stat = new_scp;
	cur_pccons = new_pccons;
	if (old_scp->status & KBD_RAW_MODE || new_scp->status & KBD_RAW_MODE)
		shfts = ctls = alts = 0;
	update_leds(new_scp->status & LED_MASK);
	set_mode(new_scp);
	new_scp->crt_base = Crtat;
	move_crsr(new_scp, new_scp->posx, new_scp->posy);
	bcopy(new_scp->scr, Crtat, new_scp->max_posx * new_scp->max_posy * 2);
	nx_scr = 0;
}


static void move_crsr(scr_stat *scp, int x, int y)
{
	if (x < 0 || y < 0 || x >= scp->max_posx || y >= scp->max_posy)
		return;
	scp->posx = x;
	scp->posy = y;
	scp->crtat = scp->crt_base + scp->posy * scp->max_posx + scp->posx;
}


static void move_up(u_short *s, u_short *d, u_int len)
{
	s += len;
	d += len;
	while (len-- > 0)
		*--d = *--s;
}


static void move_down(u_short *s, u_short *d, u_int len)
{
	while (len-- > 0)
		*d++ = *s++;
}


static void scan_esc(scr_stat *scp, u_char c)
{
	static u_char ansi_col[16] = 
		{0, 4, 2, 6, 1, 5, 3, 7, 8, 12, 10, 14, 9, 13, 11, 15};
	int i, n;
	u_short *src, *dst, count;

	if (scp->term.esc == 1) {
		switch (c) {

		case '[': 	/* Start ESC [ sequence */
			scp->term.esc = 2;
			scp->term.last_par = -1;
			for (i = scp->term.n_par; i < MAX_ESC_PAR; i++)
				scp->term.par[i] = 1;
			scp->term.n_par = 0;
			return;

		case 'M':	/* Move cursor up 1 line, scroll if at top */
			if (scp->posy > 0)
				move_crsr(scp, scp->posx, scp->posy - 1);
			else {
				move_up(scp->crt_base, 
					scp->crt_base + scp->max_posx,
					(scp->max_posy - 1) * scp->max_posx);
				fillw(scp->term.attr | scr_map[0x20], 
				      scp->crt_base, scp->max_posx);
			}
			break;
#if notyet
		case 'Q':
			scp->term.esc = 4;
			break;
#endif
		case 'c':	/* Clear screen & home */
			clear_screen(scp);
			break;
		}
	}
	else if (scp->term.esc == 2) {
		if (c >= '0' && c <= '9') {
			if (scp->term.n_par < MAX_ESC_PAR) {
				if (scp->term.last_par != scp->term.n_par) {
					scp->term.last_par = scp->term.n_par;
					scp->term.par[scp->term.n_par] = 0;
				}
				else
					scp->term.par[scp->term.n_par] *= 10;
				scp->term.par[scp->term.n_par] += c - '0';
				return;
			}
		}
		scp->term.n_par = scp->term.last_par + 1;
		switch (c) {

		case ';':
			if (scp->term.n_par < MAX_ESC_PAR)
				return;
			break;

		case '=':
			scp->term.esc = 3;
			scp->term.last_par = -1;
			for (i = scp->term.n_par; i < MAX_ESC_PAR; i++)
				scp->term.par[i] = 1;
			scp->term.n_par = 0;
			return;

		case 'A': /* up n rows */
			n = scp->term.par[0]; if (n < 1) n = 1;
			move_crsr(scp, scp->posx, scp->posy - n);
			break;

		case 'B': /* down n rows */
			n = scp->term.par[0]; if (n < 1) n = 1;
			move_crsr(scp, scp->posx, scp->posy + n);
			break;

		case 'C': /* right n columns */
			n = scp->term.par[0]; if (n < 1) n = 1;
			move_crsr(scp, scp->posx + n, scp->posy);
			break;

		case 'D': /* left n columns */
			n = scp->term.par[0]; if (n < 1) n = 1;
			move_crsr(scp, scp->posx - n, scp->posy);
			break;

		case 'E': /* cursor to start of line n lines down */
			n = scp->term.par[0]; if (n < 1) n = 1;
			move_crsr(scp, 0, scp->posy + n);
			break;

		case 'F': /* cursor to start of line n lines up */
			n = scp->term.par[0]; if (n < 1) n = 1;
			move_crsr(scp, 0, scp->posy - n);
			break;

		case 'f': /* System V consoles .. */
		case 'H': /* Cursor move */
			if (scp->term.n_par == 0) 
				move_crsr(scp, 0, 0);
			else if (scp->term.n_par == 2)
				move_crsr(scp, scp->term.par[1] - 1, 
					  scp->term.par[0] - 1);
			break;

		case 'J': /* Clear all or part of display */
			if (scp->term.n_par == 0)
				n = 0;
			else
				n = scp->term.par[0];
			switch (n) {
			case 0: /* clear form cursor to end of display */
				fillw(scp->term.attr | scr_map[0x20],
				      scp->crtat, scp->crt_base + 
				      scp->max_posx * scp->max_posy - 
				      scp->crtat);
				break;
			case 1: /* clear from beginning of display to cursor */
				fillw(scp->term.attr | scr_map[0x20],
				      scp->crt_base, 
				      scp->crtat - scp->crt_base);
				break;
			case 2: /* clear entire display */
				clear_screen(scp);
				break;
			}
			break;

		case 'K': /* Clear all or part of line */
			if (scp->term.n_par == 0)
				n = 0;
			else
				n = scp->term.par[0];
			switch (n) {
			case 0: /* clear form cursor to end of line */
				fillw(scp->term.attr | scr_map[0x20],
				      scp->crtat, scp->max_posx - scp->posx);
				break;
			case 1: /* clear from beginning of line to cursor */
				fillw(scp->term.attr|scr_map[0x20], 
				      scp->crtat - (scp->max_posx - scp->posx),
				      (scp->max_posx - scp->posx) + 1);
				break;
			case 2: /* clear entire line */
				fillw(scp->term.attr|scr_map[0x20], 
				      scp->crtat - (scp->max_posx - scp->posx),
				      scp->max_posx);
				break;
			}
			break;

		case 'L':	/* Insert n lines */
			n = scp->term.par[0]; if (n < 1) n = 1;
			if (n > scp->max_posy - scp->posy)
				n = scp->max_posy - scp->posy;
			src = scp->crt_base + scp->posy * scp->max_posx;
			dst = src + n * scp->max_posx;
			count = scp->max_posy - (scp->posy + n);
			move_up(src, dst, count * scp->max_posx);
			fillw(scp->term.attr | scr_map[0x20], src,
			      n * scp->max_posx);
			break;

		case 'M':	/* Delete n lines */
			n = scp->term.par[0]; if (n < 1) n = 1;
			if (n > scp->max_posy - scp->posy)
				n = scp->max_posy - scp->posy;
			dst = scp->crt_base + scp->posy * scp->max_posx;
			src = dst + n * scp->max_posx;
			count = scp->max_posy - (scp->posy + n);
			move_down(src, dst, count * scp->max_posx);
			src = dst + count * scp->max_posx;
			fillw(scp->term.attr | scr_map[0x20], src,
			      n * scp->max_posx);
			break;

		case 'P':	/* Delete n chars */
			n = scp->term.par[0]; if (n < 1) n = 1;
			if (n > scp->max_posx - scp->posx)
				n = scp->max_posx - scp->posx;
			dst = scp->crtat;
			src = dst + n;
			count = scp->max_posx - (scp->posx + n);
			move_down(src, dst, count);
			src = dst + count;
			fillw(scp->term.attr | scr_map[0x20], src, n);
			break;

		case '@':	/* Insert n chars */
			n = scp->term.par[0]; if (n < 1) n = 1;
			if (n > scp->max_posx - scp->posx)
				n = scp->max_posx - scp->posx;
			src = scp->crtat;
			dst = src + n;
			count = scp->max_posx - (scp->posx + n);
			move_up(src, dst, count);
			fillw(scp->term.attr | scr_map[0x20], src, n);
			break;

		case 'S':	/* scroll up n lines */
			n = scp->term.par[0]; if (n < 1)  n = 1;
			bcopy(scp->crt_base + (scp->max_posx * n),
			      scp->crt_base, 
			      scp->max_posx * (scp->max_posy - n) * 
			      sizeof(u_short));
			fillw(scp->term.attr | scr_map[0x20],
			      scp->crt_base + scp->max_posx * 
			      (scp->max_posy - 1), 
			      scp->max_posx);
			break;

		case 'T':	/* scroll down n lines */
			n = scp->term.par[0]; if (n < 1)  n = 1;
			bcopy(scp->crt_base, 
			      scp->crt_base + (scp->max_posx * n),
			      scp->max_posx * (scp->max_posy - n) * 
			      sizeof(u_short));
			fillw(scp->term.attr | scr_map[0x20], scp->crt_base, 
			      scp->max_posx);
			break;

		case 'X':	/* delete n characters in line */
			n = scp->term.par[0]; if (n < 1)  n = 1;
			fillw(scp->term.attr | scr_map[0x20], 
                              scp->crt_base + scp->posx + 
			      ((scp->max_posx*scp->posy) * sizeof(u_short)), n);
			break;

		case 'Z':	/* move n tabs backwards */
			n = scp->term.par[0]; if (n < 1)  n = 1;
			if ((i = scp->posx & 0xf8) == scp->posx)
				i -= 8*n;
			else 
				i -= 8*(n-1); 
			if (i < 0) 
				i = 0;
			move_crsr(scp, i, scp->posy);
			break;

		case '`': 	/* move cursor to column n */
			n = scp->term.par[0]; if (n < 1)  n = 1;
			move_crsr(scp, n, scp->posy);
			break;

		case 'a': 	/* move cursor n columns to the right */
			n = scp->term.par[0]; if (n < 1)  n = 1;
			move_crsr(scp, scp->posx + n, scp->posy);
			break;

		case 'd': 	/* move cursor to row n */
			n = scp->term.par[0]; if (n < 1)  n = 1;
			move_crsr(scp, scp->posx, n);
			break;

		case 'e': 	/* move cursor n rows down */
			n = scp->term.par[0]; if (n < 1)  n = 1;
			move_crsr(scp, scp->posx, scp->posy + n);
			break;

		case 'm': 	/* change attribute */
			if (scp->term.n_par == 0)
				n = 0;
			else
				n = scp->term.par[0];
			switch (n) {
			case 0:	/* back to normal */
				scp->term.attr = scp->term.std_attr;
				break;
			case 1:	/* highlight (bold) */
				scp->term.attr &= 0xFF00;
				scp->term.attr |= 0x0800;
				break;
			case 4: /* highlight (underline) */
				scp->term.attr &= 0x0F00;
				scp->term.attr |= 0x0800;
				break;
			case 5: /* blink */
				scp->term.attr &= 0xFF00;
				scp->term.attr |= 0x8000;
				break;
			case 7: /* reverse video */
				scp->term.attr = scp->term.rev_attr; 
				break;
			case 30: case 31: case 32: case 33: /* set fg color */
			case 34: case 35: case 36: case 37:
				scp->term.attr = (scp->term.attr & 0xF0FF)
					    | (ansi_col[(n - 30) & 7] << 8);
				break;
			case 40: case 41: case 42: case 43: /* set bg color */
			case 44: case 45: case 46: case 47:
				scp->term.attr = (scp->term.attr & 0x0FFF)
					    | (ansi_col[(n - 40) & 7] << 12);
				break;
			}
			break;

		case 'x':
			if (scp->term.n_par == 0)
				n = 0;
			else
				n = scp->term.par[0];
			switch (n) {
			case 0: 	/* reset attributes */
				scp->term.attr = scp->term.std_attr =
					current_default->std_attr;
				scp->term.rev_attr = current_default->rev_attr;
				break;
			case 1: 	/* set ansi background */
				scp->term.attr = scp->term.std_attr =  
					(scp->term.std_attr & 0x0F00) |
					(ansi_col[(scp->term.par[1])&0x0F]<<12);
				break;
			case 2: 	/* set ansi foreground */
				scp->term.attr = scp->term.std_attr =  
					(scp->term.std_attr & 0xF000) |
					(ansi_col[(scp->term.par[1])&0x0F]<<8);
				break;
			case 3: 	/* set ansi attribute directly */
				scp->term.attr = scp->term.std_attr =
					(scp->term.par[1]&0xFF)<<8;
				break;
			case 5: 	/* set ansi reverse video background */
				scp->term.rev_attr = 
					(scp->term.rev_attr & 0x0F00) |
					(ansi_col[(scp->term.par[1])&0x0F]<<12);
				break;
			case 6: 	/* set ansi reverse video foreground */
				scp->term.rev_attr = 
					(scp->term.rev_attr & 0xF000) |
					(ansi_col[(scp->term.par[1])&0x0F]<<8);
				break;
			case 7: 	/* set ansi reverse video directly */
				scp->term.rev_attr = (scp->term.par[1]&0xFF)<<8;
				break;
			}
			break;

		case 'z':	/* switch to (virtual) console n */
			if (scp->term.n_par == 1)
				switch_scr(scp->term.par[0]);
			break;
		}
	}
	else if (scp->term.esc == 3) {
		if (c >= '0' && c <= '9') {
			if (scp->term.n_par < MAX_ESC_PAR) {
				if (scp->term.last_par != scp->term.n_par) {
					scp->term.last_par = scp->term.n_par;
					scp->term.par[scp->term.n_par] = 0;
				}
				else
					scp->term.par[scp->term.n_par] *= 10;
				scp->term.par[scp->term.n_par] += c - '0';
				return;
			}
		}
		scp->term.n_par = scp->term.last_par + 1;
		switch (c) {

		case ';':
			if (scp->term.n_par < MAX_ESC_PAR)
				return;
			break;

		case 'A':	/* set display border color */
			if (scp->term.n_par == 1)
				scp->border=scp->term.par[0] & 0xff;
				if (scp == cur_scr_stat)
					set_border(scp->border);
			break;

		case 'B':	/* set bell pitch and duration */
			if (scp->term.n_par == 2) {
				scp->bell_pitch = scp->term.par[0];
				scp->bell_duration = scp->term.par[1]*10;
			}
			break;

		case 'C': 	/* set cursor shape (start & end line) */
			if (scp->term.n_par == 2) {
				scp->cursor_start = scp->term.par[0] & 0x1F; 
				scp->cursor_end = scp->term.par[1] & 0x1F; 
				if (scp == cur_scr_stat)
					cursor_shape(scp->cursor_start,
						     scp->cursor_end);
			}
			break;

		case 'F':	/* set ansi foreground */
			if (scp->term.n_par == 1) 
				scp->term.attr = scp->term.std_attr =  
					(scp->term.std_attr & 0xF000) 
					| ((scp->term.par[0] & 0x0F) << 8);
			break;

		case 'G': 	/* set ansi background */
			if (scp->term.n_par == 1) 
				scp->term.attr = scp->term.std_attr =  
					(scp->term.std_attr & 0x0F00) 
					| ((scp->term.par[0] & 0x0F) << 12);
			break;

		case 'H':	/* set ansi reverse video foreground */
			if (scp->term.n_par == 1) 
				scp->term.rev_attr = 
					(scp->term.rev_attr & 0xF000) 
					| ((scp->term.par[0] & 0x0F) << 8);
			break;

		case 'I': 	/* set ansi reverse video background */
			if (scp->term.n_par == 1) 
				scp->term.rev_attr = 
					(scp->term.rev_attr & 0x0F00) 
					| ((scp->term.par[0] & 0x0F) << 12);
			break;
		}
	}
	scp->term.esc = 0;
}


static void ansi_put(scr_stat *scp, u_char c)
{
	if (scp->status & UNKNOWN_MODE) 
		return;

	/* make screensaver happy */
	if (scp == cur_scr_stat) {
		scrn_time_stamp = time.tv_sec;
		if (scrn_blanked)
			scrn_saver(0);
	}
	in_putc++;
	if (scp->term.esc)
		scan_esc(scp, c);
	else switch(c) {
	case 0x1B:	/* start escape sequence */
		scp->term.esc = 1;
		scp->term.n_par = 0;
		break;
	case 0x07:
		if (scp == cur_scr_stat)
		 	sysbeep(scp->bell_pitch, scp->bell_duration);
		break;
	case '\t':	/* non-destructive tab */
		scp->crtat += (8 - scp->posx % 8);
		scp->posx += (8 - scp->posx % 8);
		break;
	case '\b':      /* non-destructive backspace */
		if (scp->crtat > scp->crt_base) {
			scp->crtat--;
			if (scp->posx > 0)
				scp->posx--;
			else {
				scp->posx += scp->max_posx - 1;
				scp->posy--;
			}
		}
		break;
	case '\r':	/* return to pos 0 */
		move_crsr(scp, 0, scp->posy);
		break;
	case '\n':	/* newline, same pos */
		scp->crtat += scp->max_posx;
		scp->posy++;
		break;
	case '\f':	/* form feed, clears screen */
		clear_screen(scp);
		break;
	default:
		/* Print only printables */
		*scp->crtat = (scp->term.attr | scr_map[c]);
		scp->crtat++;
		if (++scp->posx >= scp->max_posx) {
			scp->posx = 0;
			scp->posy++;
		}
		break;
	}
	if (scp->crtat >= scp->crt_base + scp->max_posy * scp->max_posx) {
		bcopy(scp->crt_base + scp->max_posx, scp->crt_base,
			scp->max_posx * (scp->max_posy - 1) * sizeof(u_short));
		fillw(scp->term.attr | scr_map[0x20],
			scp->crt_base + scp->max_posx * (scp->max_posy - 1), 
			scp->max_posx);
		scp->crtat -= scp->max_posx;
		scp->posy--;
	}
	in_putc--;
	if (nx_scr)
		switch_scr(nx_scr - 1);
}


void consinit(void)
{
	u_short volatile *cp = Crtat + (CGA_BUF-MONO_BUF)/sizeof(u_short), was;
	unsigned cursorat;
	int i;

	/*
	 * catch that once in a blue moon occurence when consinit is called 
	 * TWICE, adding the CGA_BUF offset again -> poooff
	 */
	if (crtat != 0) 	
		return;
	/*
	 * Crtat initialized to point to MONO buffer, if not present change
	 * to CGA_BUF offset. ONLY ADD the difference since locore.s adds
	 * in the remapped offset at the right time
	 */
	was = *cp;
	*cp = (u_short) 0xA55A;
	if (*cp != 0xA55A) {
		crtc_addr = MONO_BASE;
	} else {
		*cp = was;
		crtc_addr = COLOR_BASE;
		Crtat = Crtat + (CGA_BUF-MONO_BUF)/sizeof(u_short);
	}

	/* Extract cursor location */
	outb(crtc_addr,14);
	cursorat = inb(crtc_addr+1)<<8 ;
	outb(crtc_addr,15);
	cursorat |= inb(crtc_addr+1);
	crtat = Crtat + cursorat;

	/* is this a VGA or higher ? */
	outb(crtc_addr, 7);
	if (inb(crtc_addr) == 7)
		crtc_vga = 1;

	current_default = &user_default;
	cons_scr_stat[0].crtat = crtat;
	cons_scr_stat[0].crt_base = Crtat;
	cons_scr_stat[0].term.esc = 0;
	cons_scr_stat[0].term.std_attr = current_default->std_attr;
	cons_scr_stat[0].term.rev_attr = current_default->rev_attr;
	cons_scr_stat[0].term.attr = current_default->std_attr;
	cons_scr_stat[0].posx = cursorat % COL;
	cons_scr_stat[0].posy = cursorat / COL;
	cons_scr_stat[0].border = BG_BLACK;;
	cons_scr_stat[0].max_posx = COL;
	cons_scr_stat[0].max_posy = ROW;
	cons_scr_stat[0].status = 0;
	cons_scr_stat[0].pid = 0;
	cons_scr_stat[0].proc = NULL;
	cons_scr_stat[0].smode.mode = VT_AUTO;
	cons_scr_stat[0].bell_pitch = 800;
	cons_scr_stat[0].bell_duration = 10;
	kernel_console.esc = 0;
	kernel_console.std_attr = kernel_default.std_attr;
	kernel_console.rev_attr = kernel_default.rev_attr;
	kernel_console.attr = kernel_default.std_attr;
	/* initialize mapscrn array to */
	for (i=0; i<sizeof(scr_map); i++)
		scr_map[i] = i;
	clear_screen(&cons_scr_stat[0]);
}


static void sput(u_char c)
{
	scr_stat *scp = &cons_scr_stat[0];
	term_stat save;

	if (crtat == 0)
		consinit();
	save = scp->term;
	scp->term = kernel_console;
	current_default = &kernel_default;
	ansi_put(scp, c);
	kernel_console = scp->term;
	current_default = &user_default;
	scp->term = save;
}


static u_char *get_fstr(u_int c, u_int *len)
{
	u_int i;

	if (!(c & FKEY))
		return(NULL);
	i = (c & 0xFF) - F_FN;
	if (i > n_fkey_tab)
		return(NULL);
	*len = fkey_tab[i].len;
	return(fkey_tab[i].str);
}


static update_leds(int which)
{
	u_char xlate_leds[8] = { 0, 4, 2, 6, 1, 5, 3, 7 };
	
	kbd_cmd(KB_SETLEDS);		/* LED Command */
	kbd_cmd(xlate_leds[which & LED_MASK]);
	kbd_wait();
}


volatile void reset_cpu(void)
{
	while (1) {
		kbd_cmd(KB_RESET_CPU);	/* Reset Command */
		DELAY(4000000);
		kbd_cmd(KB_RESET);	/* Keyboard Reset Command */
	}
}


/*
 * sgetc(noblock) : get a character from the keyboard. 
 * If noblock = 0 wait until a key is gotten.  Otherwise return a 0x100.
 */
u_int sgetc(int noblock)
{
	u_char val, code, release;
	u_int state, action;
	struct key_t *key;
	static u_char esc_flag = 0, compose = 0;
	static u_int chr = 0;

next_code:
	kbd_wait();
	/* First see if there is something in the keyboard port */
	if (inb(KB_STAT) & KB_BUF_FULL)
		val = inb(KB_DATA);
	else if (noblock)
		return(0x100);
	else
		goto next_code;

	if (cur_scr_stat->status & KBD_RAW_MODE)
		return val;

	code = val & 0x7F;
	release = val & 0x80;

	/* Check for cntl-alt-del */
	if ((code == 83) && ctls && alts)
		cpu_reset();
#if NDDB > 0
	/* Check for cntl-alt-esc */
	if ((val == 1) && ctls && alts) {
		/* if debugger called, try to switch to console 0 */
		if (cur_scr_stat->smode.mode == VT_AUTO &&
		    cons_scr_stat[0].smode.mode == VT_AUTO)
			switch_scr(0); 
		Debugger();
		return(0x100);
	}
#endif
	switch (esc_flag) {
	case 0x00:		/* normal scancode */
		switch(code) {
		case 0x38:	/* left alt  (compose key) */
			if (release && compose) {
				compose = 0;	
				if (chr > 255) {
					sysbeep(500, hz/4);
					chr = 0;
				}
			}
			else {
				if (!compose) {
					compose = 1;
					chr = 0;
				}
			}
			break;
		case 0x60:
		case 0x61:
			esc_flag = code;
			goto next_code;		
		}
		break;
	case 0x60:		/* 0xE0 prefix */
		esc_flag = 0;
		switch (code) {
		case 0x1c:	/* right enter key */
			code = 0x59;
			break;
		case 0x1d:	/* right ctrl key */
			code = 0x5a;
			break;
		case 0x35:	/* keypad divide key */
			code = 0x5b;
			break;
		case 0x37:	/* print scrn key */
			code = 0x5c;
			break;
		case 0x38:	/* right alt key (alt gr) */
			code = 0x5d;
			break;
		case 0x47:	/* grey home key */
			code = 0x5e;
			break;
		case 0x48:	/* grey up arrow key */
			code = 0x5f;
			break;
		case 0x49:	/* grey page up key */
			code = 0x60;
			break;
		case 0x4b:	/* grey left arrow key */
			code = 0x61;
			break;
		case 0x4d:	/* grey right arrow key */
			code = 0x62;
			break;
		case 0x4f:	/* grey end key */
			code = 0x63;
			break;
		case 0x50:	/* grey down arrow key */
			code = 0x64;
			break;
		case 0x51:	/* grey page down key */
			code = 0x65;
			break;
		case 0x52:	/* grey insert key */
			code = 0x66;
			break;
		case 0x53:	/* grey delete key */
			code = 0x67;
			break;
		default:	/* ignore everything else */
			goto next_code;
		}
		break;
	case 0x61:		/* 0xE1 prefix */
		esc_flag = 0;	
		if (code == 0x1D)
			esc_flag = 0x1D;
		goto next_code;
		/* NOT REACHED */
	case 0x1D:		/* pause / break */
		esc_flag = 0;	
		if (code != 0x45)
			goto next_code;
		code = 0x68;
		break;
	}

	if (compose) {
		switch (code) {
		case 0x47: 
		case 0x48:				/* keypad 7,8,9 */ 
		case 0x49:
			if (!release)
				chr = (code - 0x40) + chr*10;
			goto next_code;
		case 0x4b: 
		case 0x4c:				/* keypad 4,5,6 */ 
		case 0x4d:
			if (!release)
				chr = (code - 0x47) + chr*10;
			goto next_code;
		case 0x4f: 
		case 0x50:				/* keypad 1,2,3 */ 
		case 0x51:
			if (!release)
				chr = (code - 0x4e) + chr*10;
			goto next_code;
		case 0x52:				/* keypad 0 */
			if (!release)
				chr *= 10;
			goto next_code;
		case 0x38:				/* left alt key */
			break;
		default:
			if (chr) {
				compose = chr = 0;
				sysbeep(500, hz/4);
				goto next_code;		
			}
			break;
		}
	}
		
	state = (shfts ? 1 : 0 ) | (2 * (ctls ? 1 : 0)) | (4 * (alts ? 1 : 0));
	if ((!agrs && (cur_scr_stat->status & ALKED))
	    || (agrs && !(cur_scr_stat->status & ALKED)))
		code += ALTGR_OFFSET;
	key = &key_map.key[code];
	if ( ((key->flgs & FLAG_LOCK_C) && (cur_scr_stat->status & CLKED))
	     || ((key->flgs & FLAG_LOCK_N) && (cur_scr_stat->status & NLKED)) )
		state ^= 1;

	/* Check for make/break */
	action = key->map[state];
	if (release) { 		/* key released */
		if (key->spcl & 0x80) {
			switch (action) {
			case LSH:
				shfts &= ~1;
				break;
			case RSH:
				shfts &= ~2;
				break;
			case LCTR:
				ctls &= ~1;
				break;
			case RCTR:
				ctls &= ~2;
				break;
			case LALT:
				alts &= ~1;
				break;
			case RALT:
				alts &= ~2;
				break;
			case NLK:
				nlkcnt = 0;				
				break;
			case CLK:
				clkcnt = 0;
				break;
			case SLK:
				slkcnt = 0;
				break;
			case ASH:
				agrs = 0;
				break;
			case ALK:
				alkcnt = 0;
				break;
			}
		}
		if (chr && !compose) {
			action = chr;
			chr = 0;
			return (action);
		}
	} else {
		/* key pressed */
		if (key->spcl & (0x80>>state)) {
			switch (action) {
			/* LOCKING KEYS */
			case NLK:
				if (!nlkcnt) {
					nlkcnt++;
					if (cur_scr_stat->status & NLKED) 
						cur_scr_stat->status &= ~NLKED;
					else
						cur_scr_stat->status |= NLKED;
					update_leds(cur_scr_stat->status & LED_MASK); 
				}
				break;
			case CLK:
				if (!clkcnt) {
					clkcnt++;
					if (cur_scr_stat->status & CLKED)
						cur_scr_stat->status &= ~CLKED;
					else
						cur_scr_stat->status |= CLKED;
					update_leds(cur_scr_stat->status & LED_MASK);
				}
				break;
			case SLK:
				if (!slkcnt) {
					slkcnt++;
					if (cur_scr_stat->status & SLKED) {
						cur_scr_stat->status &= ~SLKED;
						pcstart(&pccons[get_scr_num(cur_scr_stat)]);
					} 
					else 
						cur_scr_stat->status |= SLKED;
					update_leds(cur_scr_stat->status & LED_MASK);
				}
				break;
 			case ALK:
				if (!alkcnt) {
					alkcnt++;
 					if (cur_scr_stat->status & ALKED)
 						cur_scr_stat->status &= ~ALKED;
 					else
 						cur_scr_stat->status |= ALKED;
				}
  				break;

			/* NON-LOCKING KEYS */
			case LSH:
				shfts |= 1;
				break;
			case RSH:
				shfts |= 2;
				break;
			case LCTR:
				ctls |= 1;
				break;
			case RCTR:
				ctls |= 2;
				break;
			case LALT:
				alts |= 1;
				break;
			case RALT:
				alts |= 2;
				break;
			case ASH:
				agrs = 1;
				break;
			case NOP:
				break;
			default:
				if (action >= F_SCR && action <= L_SCR) {
					switch_scr(action - F_SCR);
					break;
				}
				if (action >= F_FN && action <= L_FN) {
					return(action | FKEY);
				}
				return(action);
			}
		}
		else  return(action);
	}
	goto next_code;
}

/* July '93, jkh.  Added in for init_main.c */
void cons_highlight() 
{
	cons_scr_stat[0].term.attr &= 0xFF00;
	cons_scr_stat[0].term.attr |= 0x0800;
}

void cons_normal() 
{
	cons_scr_stat[0].term.attr = cons_scr_stat[0].term.std_attr;
}

int getchar(void)
{
	char thechar;
	int s;

	pcconsoftc.cs_flags |= CSF_POLLING;
	s = splhigh();
	sput('>');
	thechar = (char) sgetc(0);
	pcconsoftc.cs_flags &= ~CSF_POLLING;
	splx(s);
	switch (thechar) {
	default: 
		if (thechar >= scr_map[0x20])
			sput(thechar);
		return(thechar);
	case cr:
	case lf: 
		sput(cr); sput(lf);
		return(lf);
	case bs:
	case del:
		sput(bs); sput(scr_map[0x20]); sput(bs);
		return(thechar);
	case cntld:
		sput('^'); sput('D'); sput('\r'); sput('\n');
		return(0);
	}
}


int pcmmap(dev_t dev, int offset, int nprot)
{
	if (offset > 0x20000)
		return EINVAL;
	return i386_btop((VIDEOMEM + offset));
}


static void kbd_wait(void)
{
	int i;
	for (i=0; i<10000; i++)
		if ((inb(KB_STAT) & KB_READY) == 0) 
			break;
}


static void kbd_cmd(u_char command)
{
	kbd_wait();
	outb(KB_DATA, command);
}


static void set_mode(scr_stat *scp)
{
	u_char byte;
	int s;

	if (scp != cur_scr_stat)
		return;

	/* (re)activate cursor */
	untimeout(cursor_pos, 0);
	cursor_pos();
	
	/* change cursor type if set */
	if (scp->cursor_start != -1 && scp->cursor_end != -1)
		cursor_shape(scp->cursor_start, scp->cursor_end);

	/* mode change only on VGA's */
	if (!crtc_vga) 
		return;

	/* setup video hardware for the given mode */
	s = splhigh();
	switch(scp->mode) {
	case TEXT80x25:
		outb(crtc_addr, 9); byte = inb(crtc_addr+1);
		outb(crtc_addr, 9); outb(crtc_addr+1, byte | 0x0F);
    		outb(TSIDX, 0x03); outb(TSREG, 0x00);	/* select font 0 */
		break;
	case TEXT80x50:
		outb(crtc_addr, 9); byte = inb(crtc_addr+1);
		outb(crtc_addr, 9); outb(crtc_addr+1, (byte & 0xF0) | 0x07);
    		outb(TSIDX, 0x03); outb(TSREG, 0x05);	/* select font 1 */
		break;
	default:
		return;
	}
	splx(s);

	/* set border color for this (virtual) console */
	set_border(scp->border);
	return;
}


static void set_border(int color)
{
	inb(crtc_addr+6); 				/* reset flip-flop */
	outb(ATC, 0x11); outb(ATC, color); 
 	inb(crtc_addr+6); 				/* reset flip-flop */
 	outb(ATC, 0x20);			/* enable Palette */
}

static load_font(int segment, int size, char* font)
{
  	int ch, line, s;
	u_char val;

 	outb(TSIDX, 0x01); val = inb(TSREG); 		/* blank screen */
	outb(TSIDX, 0x01); outb(TSREG, val | 0x20);

	/* setup vga for loading fonts (graphics plane mode) */
	s = splhigh();
	inb(crtc_addr+6);				/* reset flip/flop */
	outb(ATC, 0x30); outb(ATC, 0x01);
	outb(TSIDX, 0x02); outb(TSREG, 0x04);
	outb(TSIDX, 0x04); outb(TSREG, 0x06);
	outb(GDCIDX, 0x04); outb(GDCREG, 0x02);
	outb(GDCIDX, 0x05); outb(GDCREG, 0x00);
	outb(GDCIDX, 0x06); outb(GDCREG, 0x05);		/* addr = a0000, 64kb */
	splx(s);
    	for (ch=0; ch < 256; ch++) 
		for (line=0; line < size; line++) 
			*((char *)atdevbase+(segment*0x4000)+(ch*32)+line) = 
				font[(ch*size)+line];	
	/* setup vga for text mode again */
	s = splhigh();
	inb(crtc_addr+6);				/* reset flip/flop */
	outb(ATC, 0x30); outb(ATC, 0x0C);
	outb(TSIDX, 0x02); outb(TSREG, 0x03);
	outb(TSIDX, 0x04); outb(TSREG, 0x02);
	outb(GDCIDX, 0x04); outb(GDCREG, 0x00);
	outb(GDCIDX, 0x05); outb(GDCREG, 0x10);
	if (crtc_addr == MONO_BASE) {
		outb(GDCIDX, 0x06); outb(GDCREG, 0x0A);	/* addr = b0000, 32kb */
	}
	else {
		outb(GDCIDX, 0x06); outb(GDCREG, 0x0E);	/* addr = b8000, 32kb */
	}
	splx(s);
 	outb(TSIDX, 0x01); val = inb(TSREG); 		/* unblank screen */
	outb(TSIDX, 0x01); outb(TSREG, val & 0xDF);
}


static void load_palette(void)
{
	int i;

  	outb(PIXMASK, 0xFF);			/* no pixelmask */
  	outb(PALWADR, 0x00);	
  	for (i=0x00; i<0x300; i++)            
    		 outb(PALDATA, palette[i]);
	inb(crtc_addr+6);			/* reset flip/flop */
	outb(ATC, 0x20);			/* enable palette */
}

static void save_palette(void)
{
	int i;

  	outb(PALRADR, 0x00);	
  	for (i=0x00; i<0x300; i++)            
    		palette[i] = inb(PALDATA);
	inb(crtc_addr+6);			/* reset flip/flop */
}


static change_winsize(struct tty *tp, int x, int y)
{
	if (tp->t_winsize.ws_col != x || tp->t_winsize.ws_row != y) {
		tp->t_winsize.ws_col = x;
		tp->t_winsize.ws_row = y;
		pgsignal(tp->t_pgrp, SIGWINCH, 1);
	}
}

#endif /* NSC */