399 lines
7.7 KiB
C
399 lines
7.7 KiB
C
/*
|
|
* Mach Operating System
|
|
* Copyright (c) 1992, 1991 Carnegie Mellon University
|
|
* All Rights Reserved.
|
|
*
|
|
* Permission to use, copy, modify and distribute this software and its
|
|
* documentation is hereby granted, provided that both the copyright
|
|
* notice and this permission notice appear in all copies of the
|
|
* software, derivative works or modified versions, and any portions
|
|
* thereof, and that both notices appear in supporting documentation.
|
|
*
|
|
* CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS"
|
|
* CONDITION. CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND FOR
|
|
* ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
|
|
*
|
|
* Carnegie Mellon requests users of this software to return to
|
|
*
|
|
* Software Distribution Coordinator or Software.Distribution@CS.CMU.EDU
|
|
* School of Computer Science
|
|
* Carnegie Mellon University
|
|
* Pittsburgh PA 15213-3890
|
|
*
|
|
* any improvements or extensions that they make and grant Carnegie Mellon
|
|
* the rights to redistribute these changes.
|
|
*
|
|
* from: Mach, Revision 2.2 92/04/04 11:35:57 rpd
|
|
* $Id: io.c,v 1.19 1996/04/30 23:43:25 bde Exp $
|
|
*/
|
|
|
|
#include "boot.h"
|
|
#include <machine/cpufunc.h>
|
|
#include <sys/reboot.h>
|
|
#ifdef PC98
|
|
#include "../../pc98/pc98_bios.h"
|
|
#endif
|
|
|
|
|
|
/*
|
|
* Gate A20 for high memory
|
|
*/
|
|
void
|
|
gateA20(void)
|
|
{
|
|
outb(0xf2, 0x00);
|
|
outb(0xf6, 0x02);
|
|
}
|
|
|
|
/* printf - only handles %d as decimal, %c as char, %s as string */
|
|
|
|
void
|
|
printf(const char *format, ...)
|
|
{
|
|
int *dataptr = (int *)&format;
|
|
char c;
|
|
|
|
dataptr++;
|
|
while ((c = *format++))
|
|
if (c != '%')
|
|
putchar(c);
|
|
else
|
|
switch (c = *format++) {
|
|
case 'd': {
|
|
int num = *dataptr++;
|
|
char buf[10], *ptr = buf;
|
|
if (num<0) {
|
|
num = -num;
|
|
putchar('-');
|
|
}
|
|
do
|
|
*ptr++ = '0'+num%10;
|
|
while (num /= 10);
|
|
do
|
|
putchar(*--ptr);
|
|
while (ptr != buf);
|
|
break;
|
|
}
|
|
case 'x': {
|
|
unsigned int num = *dataptr++, dig;
|
|
char buf[8], *ptr = buf;
|
|
do
|
|
*ptr++ = (dig=(num&0xf)) > 9?
|
|
'a' + dig - 10 :
|
|
'0' + dig;
|
|
while (num >>= 4);
|
|
do
|
|
putchar(*--ptr);
|
|
while (ptr != buf);
|
|
break;
|
|
}
|
|
case 'c': putchar((*dataptr++)&0xff); break;
|
|
case 's': {
|
|
char *ptr = (char *)*dataptr++;
|
|
while ((c = *ptr++))
|
|
putchar(c);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
void
|
|
putchar(int c)
|
|
{
|
|
if (c == '\n') {
|
|
if (loadflags & RB_SERIAL)
|
|
serial_putc('\r');
|
|
else
|
|
putc('\r');
|
|
}
|
|
if (loadflags & RB_SERIAL)
|
|
serial_putc(c);
|
|
else
|
|
putc(c);
|
|
}
|
|
|
|
int
|
|
getchar(int in_buf)
|
|
{
|
|
int c;
|
|
|
|
loop:
|
|
if ((c = ((loadflags & RB_SERIAL) ? serial_getc() : getc())) == '\r')
|
|
c = '\n';
|
|
if (c == '\b') {
|
|
if (in_buf != 0) {
|
|
putchar('\b');
|
|
putchar(' ');
|
|
} else {
|
|
goto loop;
|
|
}
|
|
}
|
|
putchar(c);
|
|
return(c);
|
|
}
|
|
|
|
#ifdef PROBE_KEYBOARD
|
|
/*
|
|
* This routine uses an inb to an unused port, the time to execute that
|
|
* inb is approximately 1.25uS. This value is pretty constant across
|
|
* all CPU's and all buses, with the exception of some PCI implentations
|
|
* that do not forward this I/O adress to the ISA bus as they know it
|
|
* is not a valid ISA bus address, those machines execute this inb in
|
|
* 60 nS :-(.
|
|
*
|
|
* XXX this should be converted to use bios_tick.
|
|
*/
|
|
void
|
|
delay1ms(void)
|
|
{
|
|
#ifdef PC98
|
|
int i = 800;
|
|
while (--i >= 0)
|
|
(void)outb(0x5f,0); /* about 600ns */
|
|
#else
|
|
int i = 800;
|
|
while (--i >= 0)
|
|
(void)inb(0x84);
|
|
#endif
|
|
}
|
|
#endif /* PROBE_KEYBOARD */
|
|
|
|
static __inline int
|
|
isch(void)
|
|
{
|
|
int isc;
|
|
|
|
/*
|
|
* Checking the keyboard has the side effect of enabling clock
|
|
* interrupts so that bios_tick works. Check the keyboard to
|
|
* get this side effect even if we only want the serial status.
|
|
*/
|
|
isc = ischar();
|
|
|
|
if (!(loadflags & RB_SERIAL))
|
|
return (isc);
|
|
return (serial_ischar());
|
|
|
|
}
|
|
|
|
#ifdef PC98
|
|
static __inline unsigned
|
|
#else
|
|
static __inline unsigned
|
|
#endif
|
|
pword(unsigned physaddr)
|
|
{
|
|
#ifdef PC98
|
|
static int counter = 0;
|
|
int i;
|
|
|
|
for (i = 0; i < 512; i++)
|
|
(void)outb(0x5f, 0);
|
|
|
|
return (counter++);
|
|
#else
|
|
unsigned result;
|
|
|
|
/*
|
|
* Give the fs prefix separately because gas omits it for
|
|
* "movl %fs:0x46c, %eax".
|
|
*/
|
|
__asm __volatile("fs; movl %1, %0" : "=r" (result)
|
|
: "m" (*(unsigned *)physaddr));
|
|
return (result);
|
|
#endif
|
|
}
|
|
|
|
int
|
|
gets(char *buf)
|
|
{
|
|
#define bios_tick pword(0x46c)
|
|
#ifdef PC98
|
|
#define BIOS_TICK_MS 1
|
|
#else
|
|
#define BIOS_TICK_MS 55
|
|
#endif
|
|
unsigned initial_bios_tick;
|
|
char *ptr=buf;
|
|
|
|
#if BOOTWAIT
|
|
for (initial_bios_tick = bios_tick;
|
|
bios_tick - initial_bios_tick < BOOTWAIT / BIOS_TICK_MS;)
|
|
#endif
|
|
if (isch())
|
|
for (;;) {
|
|
switch(*ptr = getchar(ptr - buf) & 0xff) {
|
|
case '\n':
|
|
case '\r':
|
|
*ptr = '\0';
|
|
return 1;
|
|
case '\b':
|
|
if (ptr > buf) ptr--;
|
|
continue;
|
|
default:
|
|
ptr++;
|
|
}
|
|
#if TIMEOUT + 0
|
|
#if !BOOTWAIT
|
|
#error "TIMEOUT without BOOTWAIT"
|
|
#endif
|
|
for (initial_bios_tick = bios_tick;;) {
|
|
if (isch())
|
|
break;
|
|
if (bios_tick - initial_bios_tick >=
|
|
TIMEOUT / BIOS_TICK_MS)
|
|
return 0;
|
|
}
|
|
#endif
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
strcmp(const char *s1, const char *s2)
|
|
{
|
|
while (*s1 == *s2) {
|
|
if (!*s1++)
|
|
return 0;
|
|
s2++;
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
void
|
|
bcopy(const char *from, char *to, int len)
|
|
{
|
|
while (len-- > 0)
|
|
*to++ = *from++;
|
|
}
|
|
|
|
/* To quote Ken: "You are not expected to understand this." :) */
|
|
|
|
void
|
|
twiddle(void)
|
|
{
|
|
putchar((char)tw_chars);
|
|
tw_chars = (tw_chars >> 8) | ((tw_chars & (unsigned long)0xFF) << 24);
|
|
putchar('\b');
|
|
}
|
|
|
|
static unsigned short *Crtat = (unsigned short *)0;
|
|
static int row;
|
|
static int col;
|
|
|
|
void putc(int c)
|
|
{
|
|
static unsigned short *crtat;
|
|
unsigned char sys_type;
|
|
unsigned short *cp;
|
|
int i, pos;
|
|
|
|
if (Crtat == 0) {
|
|
sys_type = *(unsigned char *)0x11501;
|
|
if (sys_type & 0x08) {
|
|
Crtat = (unsigned short *)0x50000;
|
|
crtat = Crtat;
|
|
row = 31;
|
|
col = 80;
|
|
} else {
|
|
Crtat = (unsigned short *)0x10000;
|
|
crtat = Crtat;
|
|
row = 25;
|
|
col = 80;
|
|
}
|
|
}
|
|
|
|
switch(c) {
|
|
case '\t':
|
|
do {
|
|
putc(' ');
|
|
} while ((int)crtat % 16);
|
|
break;
|
|
case '\b':
|
|
crtat--;
|
|
break;
|
|
case '\r':
|
|
crtat -= (crtat - Crtat) % col;
|
|
break;
|
|
case '\n':
|
|
crtat += col;
|
|
break;
|
|
default:
|
|
*crtat = (c == 0x5c ? 0xfc : c);
|
|
*(crtat++ + 0x1000) = 0xe1;
|
|
break;
|
|
}
|
|
|
|
if (crtat >= Crtat + col * row) {
|
|
for (i = 1; i < row; i++)
|
|
bcopy((void*)(Crtat+col*i), (void*)(Crtat+col*(i-1)), col*2);
|
|
for (i = 0, cp = Crtat + col * (row - 1); i < col*2; i++) {
|
|
*cp++ = ' ';
|
|
}
|
|
crtat -= col;
|
|
}
|
|
pos = crtat - Crtat;
|
|
while((inb(0x60) & 0x04) == 0) {}
|
|
outb(0x62, 0x49);
|
|
outb(0x60, pos & 0xff);
|
|
outb(0x60, pos >> 8);
|
|
}
|
|
|
|
void machine_check(void)
|
|
{
|
|
int ret;
|
|
int i;
|
|
int data = 0;
|
|
u_char epson_machine_id = *(unsigned char *)(0x11624);
|
|
|
|
/* PC98_SYSTEM_PARAMETER(0x501) */
|
|
ret = ((*(unsigned char*)0x11501) & 0x08) ? M_HIGHRESO : M_NORMAL;
|
|
|
|
/* wait V-SYNC */
|
|
while (inb(0x60) & 0x20) {}
|
|
while (!(inb(0x60) & 0x20)) {}
|
|
|
|
/* ANK 'A' font */
|
|
outb(0xa1, 0x00);
|
|
outb(0xa3, 0x41);
|
|
|
|
/* M_NORMAL, use CG window (all NEC OK) */
|
|
/* sum */
|
|
for (i = 0; i < 4; i++) {
|
|
data += *((unsigned long*)0x14000 + i);/* 0xa4000 */
|
|
}
|
|
if (data == 0x6efc58fc) { /* DA data */
|
|
ret |= M_NEC_PC98;
|
|
} else {
|
|
ret |= M_EPSON_PC98;
|
|
}
|
|
ret |= (inb(0x42) & 0x20) ? M_8M : 0;
|
|
|
|
/* PC98_SYSTEM_PARAMETER(0x400) */
|
|
if ((*(unsigned char*)0x11400) & 0x80) {
|
|
ret |= M_NOTE;
|
|
}
|
|
if (ret & M_NEC_PC98) {
|
|
/* PC98_SYSTEM_PARAMETER(0x458) */
|
|
if ((*(unsigned char*)0x11458) & 0x80) {
|
|
ret |= M_H98;
|
|
} else {
|
|
ret |= M_NOT_H98;
|
|
}
|
|
} else {
|
|
ret |= M_NOT_H98;
|
|
switch (epson_machine_id) {
|
|
case 0x20: /* note A */
|
|
case 0x22: /* note W */
|
|
case 0x27: /* note AE */
|
|
case 0x2a: /* note WR */
|
|
/*case 0x2: /* note AR */
|
|
ret |= M_NOTE;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
(*(unsigned long *)(0x11620)) = ret;
|
|
}
|