Make sc0 the default to match our GENERIC* kernels.

[unix-history] / sys / i386 / netboot / misc.c

/**************************************************************************
MISC Support Routines
**************************************************************************/

#include "netboot.h"

#define NO_SWITCH		/* saves space */

/**************************************************************************
TWIDDLE
**************************************************************************/
twiddle()
{
	static int count=0;
	char tiddles[]="-\\|/";
	putchar(tiddles[(count++)&3]);
	putchar('\b');
}

/**************************************************************************
BCOPY
**************************************************************************/
bcopy(s,d,n)
	char *s, *d;
	int n;
{
	while ((n--) > 0) {
		*(d++) = *(s++);
	}
}

/**************************************************************************
BZERO
**************************************************************************/
bzero(d,n)
	char *d;
	int n;
{
	while ((n--) > 0) {
		*(d++) = 0;
	}
}

/**************************************************************************
BCOMPARE
**************************************************************************/
bcompare(d,s,n)
	char *d,*s;
	int n;
{
	while ((n--) > 0) {
		if (*(d++) != *(s++)) return(0);
	}
	return(1);
}


/**************************************************************************
PRINTF
**************************************************************************/
printf(fmt, data)
	char *fmt;
	int  data;
{
	char *p;
	int *dp = &data;
	while (*fmt) {
		if (*fmt == '%') {	/* switch() uses more space */
			fmt++;
			if (*fmt == 'X')
				printhl(*dp++);
			if (*fmt == 'x')
				printhw(*dp++);
			if (*fmt == 'd')
				printdec(*dp++);
			if (*fmt == 'I')
				printip(*dp++);
			if (*fmt == 'c')
				putchar(*(dp++) & 0x00FF);
			if (*fmt == 's') {
				p = (char *)*dp++;
				while (*p) putchar(*p++);
			}
		} else putchar(*fmt);
		fmt++;
	}
	return(0);
}


/**************************************************************************
PRINTDEC - Print a number in decimal
**************************************************************************/
printdec(n)
	int n;
{
	char buf[16], *p;
	p = buf;
	if (n < 0) {
		putchar('-');
		n = -n;
	}
	do {
		*(p++) = '0' + (n%10);
		n = n/10;
	} while(n);
	while ((--p) >= buf) putchar(*p);
}

char *putdec(p, n)
	char *p;
	int n;
{
	n = n & 0x00FF;
	if (n/100) *(p++) = '0' + (n/100);
	if (n/10) *(p++) = '0' + ((n/10) % 10);
	*(p++) = '0' + (n%10);
	return(p);
}

/**************************************************************************
PRINTDEC - Print a number in decimal
**************************************************************************/
static char hex[]="0123456789ABCDEF";
printhl(h) {
	printhw(h>>16);
	printhw(h);
}
printhw(h) {
	printhb(h>>8);
	printhb(h);
}
printhb(h) {
	putchar(hex[(h>>4)& 0x0F]);
	putchar(hex[h &0x0F]);
}

/**************************************************************************
PRINTIP - Print an IP address in x.x.x.x notation
**************************************************************************/
printip(i)
	unsigned i;
{
	printdec((i>>24) & 0x0FF);
	putchar('.');
	printdec((i>>16) & 0x0FF);
	putchar('.');
	printdec((i>>8) & 0x0FF);
	putchar('.');
	printdec(i & 0x0FF);
}

/**************************************************************************
SETIP - Convert an ascii x.x.x.x to binary form
**************************************************************************/
setip(p, i)
	char *p;
	unsigned *i;
{
	unsigned ip = 0;
	int val;
	if (((val = getdec(&p)) < 0) || (val > 255)) return(0);
	if (*p != '.') return(0);
	p++;
	ip = val;
	if (((val = getdec(&p)) < 0) || (val > 255)) return(0);
	if (*p != '.') return(0);
	p++;
	ip = (ip << 8) | val;
	if (((val = getdec(&p)) < 0) || (val > 255)) return(0);
	if (*p != '.') return(0);
	p++;
	ip = (ip << 8) | val;
	if (((val = getdec(&p)) < 0) || (val > 255)) return(0);
	*i = (ip << 8) | val;
	return(1);
}

getdec(ptr)
	char **ptr;
{
	char *p = *ptr;
	int ret=0;
	if ((*p < '0') || (*p > '9')) return(-1);
	while ((*p >= '0') && (*p <= '9')) {
		ret = ret*10 + (*p - '0');
		p++;
	}
	*ptr = p;
	return(ret);
}


#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 */

/*
 * Gate A20 for high memory
 */
unsigned char	x_20 = KB_A20;
gateA20()
{
#ifdef	IBM_L40
	outb(0x92, 0x2);
#else	IBM_L40
	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);
#endif	IBM_L40
}