summaryrefslogtreecommitdiffstats
path: root/board/MAI/bios_emulator/scitech/src/v86bios/v86bios.c
diff options
context:
space:
mode:
Diffstat (limited to 'board/MAI/bios_emulator/scitech/src/v86bios/v86bios.c')
-rw-r--r--board/MAI/bios_emulator/scitech/src/v86bios/v86bios.c933
1 files changed, 933 insertions, 0 deletions
diff --git a/board/MAI/bios_emulator/scitech/src/v86bios/v86bios.c b/board/MAI/bios_emulator/scitech/src/v86bios/v86bios.c
new file mode 100644
index 0000000000..7a3fb36655
--- /dev/null
+++ b/board/MAI/bios_emulator/scitech/src/v86bios/v86bios.c
@@ -0,0 +1,933 @@
+/*
+ * Copyright 1999 Egbert Eich
+ *
+ * Permission to use, copy, modify, distribute, and sell this software and its
+ * documentation for any purpose is hereby granted without fee, provided that
+ * the above copyright notice appear in all copies and that both that
+ * copyright notice and this permission notice appear in supporting
+ * documentation, and that the name of the authors not be used in
+ * advertising or publicity pertaining to distribution of the software without
+ * specific, written prior permission. The authors makes no representations
+ * about the suitability of this software for any purpose. It is provided
+ * "as is" without express or implied warranty.
+ *
+ * THE AUTHORS DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE,
+ * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO
+ * EVENT SHALL THE AUTHORS BE LIABLE FOR ANY SPECIAL, INDIRECT OR
+ * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE,
+ * DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
+ * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
+ * PERFORMANCE OF THIS SOFTWARE.
+ */
+#define DELETE
+#include <unistd.h>
+#include <fcntl.h>
+#include <stdio.h>
+#include <sys/mman.h>
+#include <sys/types.h>
+#include <string.h>
+#include <stdlib.h>
+#include <signal.h>
+#include <sys/stat.h>
+#include <readline/readline.h>
+#include <readline/history.h>
+#if defined(__alpha__) || defined (__ia64__)
+#include <sys/io.h>
+#elif defined(HAVE_SYS_PERM)
+#include <sys/perm.h>
+#endif
+#include "debug.h"
+#include "v86bios.h"
+#include "pci.h"
+#include "AsmMacros.h"
+
+#define SIZE 0x100000
+#define VRAM_START 0xA0000
+#define VRAM_SIZE 0x1FFFF
+#define V_BIOS_SIZE 0x1FFFF
+#define BIOS_START 0x7C00 /* default BIOS entry */
+#define BIOS_MEM 0x600
+
+//CARD8 code[] = { 0xb8 , 0xf0 , 0xf0, 0xf4 };
+#define VB_X(x) (V_BIOS >> x) & 0xFF
+CARD8 code[] = { 6, 0x9a, 0x03, 0x00, 0x00, VB_X(12), 0xf4 };
+//CARD8 code[] = { 0x9a, 0x03, 0x00, 0x00, VB_X(12), 0xb8, 0x03, 0x00,
+//0xcd, 0x10, 0xf4 };
+//CARD8 code[] = { 0xb8 , 0xf0 , 0xf0 ,0xf4 };
+
+int ioperm_list[IOPERM_BITS] = {0,};
+
+static void sig_handler(int);
+static int map(void);
+static void unmap(void);
+static void bootBIOS(CARD16 ax);
+static int map_vram(void);
+static void unmap_vram(void);
+static int copy_vbios(memType v_base);
+static int copy_sys_bios(void);
+static void save_bios_to_file(void);
+static int setup_system_bios(void);
+static CARD32 setup_int_vect(void);
+#ifdef __ia32__
+static CARD32 setup_primary_int_vect(void);
+#endif
+static int chksum(CARD8 *start);
+static void setup_bios_regs(i86biosRegsPtr regs, CARD32 ax);
+static void print_regs(i86biosRegsPtr regs);
+static void print_usage(void);
+static void set_hlt(Bool set);
+static void set_ioperm(void);
+
+extern void yyparse();
+
+void loadCodeToMem(unsigned char *ptr, CARD8 *code);
+void dprint(unsigned long start, unsigned long size);
+
+static int vram_mapped = 0;
+static char* bios_var = NULL;
+static CARD8 save_msr;
+static CARD8 save_pos102;
+static CARD8 save_vse;
+static CARD8 save_46e8;
+static haltpoints hltp[20] = { {0, 0}, };
+
+console Console = {-1,-1};
+struct config Config;
+
+int main(int argc,char **argv)
+{
+ int c;
+
+ Config.PrintPort = PRINT_PORT;
+ Config.IoStatistics = IO_STATISTICS;
+ Config.PrintIrq = PRINT_IRQ;
+ Config.PrintPci = PRINT_PCI;
+ Config.ShowAllDev = SHOW_ALL_DEV;
+ Config.PrintIp = PRINT_IP;
+ Config.SaveBios = SAVE_BIOS;
+ Config.Trace = TRACE;
+ Config.ConfigActiveOnly = CONFIG_ACTIVE_ONLY; /* boot */
+ Config.ConfigActiveDevice = CONFIG_ACTIVE_DEVICE; /* boot */
+ Config.MapSysBios = MAP_SYS_BIOS;
+ Config.Resort = RESORT; /* boot */
+ Config.FixRom = FIX_ROM;
+ Config.NoConsole = NO_CONSOLE;
+ Config.BootOnly = FALSE;
+ Config.Verbose = VERBOSE;
+
+ opterr = 0;
+ while ((c = getopt(argc,argv,"psicaPStAdbrfnv:?")) != EOF) {
+ switch(c) {
+ case 'p':
+ Config.PrintPort = TRUE;
+ break;
+ case 's':
+ Config.IoStatistics = TRUE;
+ break;
+ case 'i':
+ Config.PrintIrq = TRUE;
+ break;
+ case 'c':
+ Config.PrintPci = TRUE;
+ break;
+ case 'a':
+ Config.ShowAllDev = TRUE;
+ break;
+ case 'P':
+ Config.PrintIp = TRUE;
+ break;
+ case 'S':
+ Config.SaveBios = TRUE;
+ break;
+ case 't':
+ Config.Trace = TRUE;
+ break;
+ case 'A':
+ Config.ConfigActiveOnly = TRUE;
+ break;
+ case 'd':
+ Config.ConfigActiveDevice = TRUE;
+ break;
+ case 'b':
+ Config.MapSysBios = TRUE;
+ break;
+ case 'r':
+ Config.Resort = TRUE;
+ break;
+ case 'f':
+ Config.FixRom = TRUE;
+ break;
+ case 'n':
+ Config.NoConsole = TRUE;
+ break;
+ case 'v':
+ Config.Verbose = strtol(optarg,NULL,0);
+ break;
+ case '?':
+ print_usage();
+ break;
+ default:
+ break;
+ }
+ }
+
+
+ if (!map())
+ exit(1);
+
+ if (!setup_system_bios())
+ exit(1);
+
+ iopl(3);
+
+ scan_pci();
+
+ save_msr = inb(0x3CC);
+ save_vse = inb(0x3C3);
+ save_46e8 = inb(0x46e8);
+ save_pos102 = inb(0x102);
+
+ if (Config.BootOnly) {
+
+ if (!CurrentPci && !Config.ConfigActiveDevice
+ && !Config.ConfigActiveOnly) {
+ iopl(0);
+ unmap();
+ exit (1);
+ }
+ call_boot(NULL);
+ } else {
+ using_history();
+ yyparse();
+ }
+
+ unmap();
+
+ pciVideoRestore();
+
+ outb(0x102, save_pos102);
+ outb(0x46e8, save_46e8);
+ outb(0x3C3, save_vse);
+ outb(0x3C2, save_msr);
+
+ iopl(0);
+
+ close_console(Console);
+
+ exit(0);
+}
+
+
+void
+call_boot(struct device *dev)
+{
+ int Active_is_Pci = 0;
+ CARD32 vbios_base;
+
+ CurrentPci = PciList;
+ Console = open_console();
+
+ set_ioperm();
+
+
+ signal(2,sig_handler);
+ signal(11,sig_handler);
+
+ /* disable primary card */
+ pciVideoRestore(); /* reset PCI state to see primary card */
+ outb(0x3C2,~(CARD8)0x03 & save_msr);
+ outb(0x3C3,~(CARD8)0x01 & save_vse);
+ outb(0x46e8, ~(CARD8)0x08 & save_46e8);
+ outb(0x102, ~(CARD8)0x01 & save_pos102);
+
+ pciVideoDisable();
+
+ while (CurrentPci) {
+ CARD16 ax;
+
+ if (CurrentPci->active) {
+ Active_is_Pci = 1;
+ if (!Config.ConfigActiveDevice && !dev) {
+ CurrentPci = CurrentPci->next;
+ continue;
+ }
+ } else if (Config.ConfigActiveOnly && !dev) {
+ CurrentPci = CurrentPci->next;
+ continue;
+ }
+ if (dev && ((dev->type != PCI)
+ || (dev->type == PCI
+ && (dev->loc.pci.dev != CurrentPci->dev
+ || dev->loc.pci.bus != CurrentPci->bus
+ || dev->loc.pci.func != CurrentPci->func)))) {
+ CurrentPci = CurrentPci->next;
+ continue;
+ }
+
+ EnableCurrent();
+
+ if (CurrentPci->active) {
+ outb(0x102, save_pos102);
+ outb(0x46e8, save_46e8);
+ outb(0x3C3, save_vse);
+ outb(0x3C2, save_msr);
+ }
+
+ /* clear interrupt vectors */
+#ifdef __ia32__
+ vbios_base = CurrentPci->active ? setup_primary_int_vect()
+ : setup_int_vect();
+#else
+ vbios_base = setup_int_vect();
+#endif
+ ax = ((CARD16)(CurrentPci->bus) << 8)
+ | (CurrentPci->dev << 3) | (CurrentPci->func & 0x7);
+ if (Config.Verbose > 1) P_printf("ax: 0x%x\n",ax);
+
+ BootBios = findPciByIDs(CurrentPci->bus,CurrentPci->dev,
+ CurrentPci->func);
+ if (!((mapPciRom(BootBios) && chksum((CARD8*)V_BIOS))
+ || (CurrentPci->active && copy_vbios(vbios_base)))) {
+ CurrentPci = CurrentPci->next;
+ continue;
+ }
+ if (!map_vram()) {
+ CurrentPci = CurrentPci->next;
+ continue;
+ }
+ if (Config.SaveBios) save_bios_to_file();
+ printf("initializing PCI bus: %i dev: %i func: %i\n",CurrentPci->bus,
+ CurrentPci->dev,CurrentPci->func);
+ bootBIOS(ax);
+ unmap_vram();
+
+ if (CurrentPci->active)
+ close_console(Console);
+
+ if (dev) return;
+
+ CurrentPci = CurrentPci->next;
+ }
+
+ /* We have an ISA device - configure if requested */
+ if (!Active_is_Pci /* no isa card in system! */
+ && ((!dev && (Config.ConfigActiveDevice || Config.ConfigActiveOnly))
+ || (dev && dev->type == ISA))) {
+
+ pciVideoDisable();
+
+ if (!dev || dev->type == ISA) {
+ outb(0x102, save_pos102);
+ outb(0x46e8, save_46e8);
+ outb(0x3C3, save_vse);
+ outb(0x3C2, save_msr);
+
+#ifdef __ia32__
+ vbios_base = setup_primary_int_vect();
+#else
+ vbios_base = setup_int_vect();
+#endif
+ if (copy_vbios(vbios_base)) {
+
+ if (Config.SaveBios) save_bios_to_file();
+ if (map_vram()) {
+ printf("initializing ISA bus\n");
+ bootBIOS(0);
+ }
+ }
+
+ unmap_vram();
+ sleep(1);
+ close_console(Console);
+ }
+ }
+
+
+}
+
+int
+map(void)
+{
+ void* mem;
+ mem = mmap(0, (size_t)SIZE,
+ PROT_EXEC | PROT_READ | PROT_WRITE,
+ MAP_FIXED | MAP_PRIVATE | MAP_ANON,
+ -1, 0 );
+ if (mem != 0) {
+ perror("anonymous map");
+ return (0);
+ }
+ memset(mem,0,SIZE);
+
+ return (1);
+}
+
+static void
+unmap(void)
+{
+ munmap(0,SIZE);
+}
+
+static void
+bootBIOS(CARD16 ax)
+{
+ i86biosRegs bRegs;
+#ifdef V86BIOS_DEBUG
+ printf("starting BIOS\n");
+#endif
+ setup_io();
+ setup_bios_regs(&bRegs, ax);
+ loadCodeToMem((unsigned char *) BIOS_START, code);
+ do_x86(BIOS_START,&bRegs);
+#ifdef V86BIOS_DEBUG
+ printf("done\n");
+#endif
+}
+
+static int
+map_vram(void)
+{
+ int mem_fd;
+
+#ifdef __ia64__
+ if ((mem_fd = open(MEM_FILE,O_RDWR | O_SYNC))<0)
+#else
+ if ((mem_fd = open(MEM_FILE,O_RDWR))<0)
+#endif
+ {
+ perror("opening memory");
+ return 0;
+ }
+
+#ifdef __alpha__
+ if (!_bus_base()) sparse_shift = 7; /* Uh, oh, JENSEN... */
+ if (!_bus_base_sparse()) sparse_shift = 0;
+ if ((vram_map = mmap(0,(size_t) (VRAM_SIZE << sparse_shift),
+ PROT_READ | PROT_WRITE,
+ MAP_SHARED,
+ mem_fd, (VRAM_START << sparse_shift)
+ | _bus_base_sparse())) == (void *) -1)
+#else
+ if (mmap((void *) VRAM_START, (size_t) VRAM_SIZE,
+ PROT_EXEC | PROT_READ | PROT_WRITE, MAP_SHARED | MAP_FIXED,
+ mem_fd, VRAM_START) == (void *) -1)
+#endif
+ {
+ perror("mmap error in map_hardware_ram (1)");
+ close(mem_fd);
+ return (0);
+ }
+ vram_mapped = 1;
+ close(mem_fd);
+ return (1);
+}
+
+static void
+unmap_vram(void)
+{
+ if (!vram_mapped) return;
+
+ munmap((void*)VRAM_START,VRAM_SIZE);
+ vram_mapped = 0;
+}
+
+static int
+copy_vbios(memType v_base)
+{
+ int mem_fd;
+ unsigned char *tmp;
+ int size;
+
+ if ((mem_fd = open(MEM_FILE,O_RDONLY))<0) {
+ perror("opening memory");
+ return (0);
+ }
+
+ if (lseek(mem_fd,(off_t) v_base, SEEK_SET) != (off_t) v_base) {
+ fprintf(stderr,"Cannot lseek\n");
+ goto Error;
+ }
+ tmp = (unsigned char *)malloc(3);
+ if (read(mem_fd, (char *)tmp, (size_t) 3) != (size_t) 3) {
+ fprintf(stderr,"Cannot read\n");
+ goto Error;
+ }
+ if (lseek(mem_fd,(off_t) v_base,SEEK_SET) != (off_t) v_base)
+ goto Error;
+
+ if (*tmp != 0x55 || *(tmp+1) != 0xAA ) {
+ fprintf(stderr,"No bios found at: 0x%lx\n",v_base);
+ goto Error;
+ }
+#ifdef DEBUG
+ dprint((unsigned long)tmp,0x100);
+#endif
+ size = *(tmp+2) * 512;
+
+ if (read(mem_fd, (char *)v_base, (size_t) size) != (size_t) size) {
+ fprintf(stderr,"Cannot read\n");
+ goto Error;
+ }
+ free(tmp);
+ close(mem_fd);
+ if (!chksum((CARD8*)v_base))
+ return (0);
+
+ return (1);
+
+Error:
+ perror("v_bios");
+ close(mem_fd);
+ return (0);
+}
+
+static int
+copy_sys_bios(void)
+{
+#define SYS_BIOS 0xF0000
+ int mem_fd;
+
+ if ((mem_fd = open(MEM_FILE,O_RDONLY))<0) {
+ perror("opening memory");
+ return (0);
+ }
+
+ if (lseek(mem_fd,(off_t) SYS_BIOS,SEEK_SET) != (off_t) SYS_BIOS)
+ goto Error;
+ if (read(mem_fd, (char *)SYS_BIOS, (size_t) 0xFFFF) != (size_t) 0xFFFF)
+ goto Error;
+
+ close(mem_fd);
+ return (1);
+
+Error:
+ perror("sys_bios");
+ close(mem_fd);
+ return (0);
+}
+
+void
+loadCodeToMem(unsigned char *ptr, CARD8 code[])
+{
+ int i;
+ CARD8 val;
+ int size = code[0];
+
+ for ( i=1;i<=size;i++) {
+ val = code[i];
+ *ptr++ = val;
+ }
+ return;
+}
+
+void
+dprint(unsigned long start, unsigned long size)
+{
+ int i,j;
+ char *c = (char *)start;
+
+ for (j = 0; j < (size >> 4); j++) {
+ char *d = c;
+ printf("\n0x%lx: ",(unsigned long)c);
+ for (i = 0; i<16; i++)
+ printf("%2.2x ",(unsigned char) (*(c++)));
+ c = d;
+ for (i = 0; i<16; i++) {
+ printf("%c",((((CARD8)(*c)) > 32) && (((CARD8)(*c)) < 128)) ?
+ (unsigned char) (*(c)): '.');
+ c++;
+ }
+ }
+ printf("\n");
+}
+
+static void
+save_bios_to_file(void)
+{
+ static int num = 0;
+ int size, count;
+ char file_name[256];
+ int fd;
+
+ sprintf(file_name,"bios_%i.fil",num);
+ if ((fd = open(file_name,O_WRONLY | O_CREAT | O_TRUNC,00644)) == -1)
+ return;
+ size = (*(unsigned char*)(V_BIOS + 2)) * 512;
+#ifdef V86BIOS_DEBUG
+ dprint(V_BIOS,20);
+#endif
+ if ((count = write(fd,(void *)(V_BIOS),size)) != size)
+ fprintf(stderr,"only saved %i of %i bytes\n",size,count);
+ num++;
+}
+
+static void
+sig_handler(int unused)
+{
+ fflush(stdout);
+ fflush(stderr);
+
+ /* put system back in a save state */
+ unmap_vram();
+ pciVideoRestore();
+ outb(0x102, save_pos102);
+ outb(0x46e8, save_46e8);
+ outb(0x3C3, save_vse);
+ outb(0x3C2, save_msr);
+
+ close_console(Console);
+ iopl(0);
+ unmap();
+
+ exit(1);
+}
+
+/*
+ * For initialization we just pass ax to the BIOS.
+ * PCI BIOSes need this. All other register are set 0.
+ */
+static void setup_bios_regs(i86biosRegsPtr regs, CARD32 ax)
+{
+ regs->ax = ax;
+ regs->bx = 0;
+ regs->cx = 0;
+ regs->dx = 0;
+ regs->es = 0;
+ regs->ds = 0x40; /* standard pc ds */
+ regs->si = 0;
+ regs->di = 0;
+}
+
+/*
+ * here we are really paranoid about faking a "real"
+ * BIOS. Most of this information was pulled from
+ * dosem.
+ */
+
+#ifdef __ia32__
+static CARD32
+setup_primary_int_vect(void)
+{
+ int mem_fd;
+ CARD32 vbase;
+ void *map;
+
+ if ((mem_fd = open(MEM_FILE,O_RDWR))<0)
+ {
+ perror("opening memory");
+ return (0);
+ }
+
+ if ((map = mmap((void *) 0, (size_t) 0x2000,
+ PROT_EXEC | PROT_READ | PROT_WRITE, MAP_SHARED,
+ mem_fd, 0)) == (void *)-1) {
+ perror("mmap error in map_hardware_ram (2)");
+ close(mem_fd);
+ return (0);
+ }
+
+ close(mem_fd);
+ memcpy(0,map,BIOS_MEM);
+ munmap(map,0x2000);
+ /*
+ * create a backup copy of the bios variables to write back the
+ * modified values
+ */
+ if (!bios_var)
+ bios_var = (char *)malloc(BIOS_MEM);
+ memcpy(bios_var,0,BIOS_MEM);
+
+ vbase = (*((CARD16*)(0x10 << 2) + 1)) << 4;
+ if (Config.Verbose > 0) printf("vbase: 0x%x\n",vbase);
+ return vbase;
+}
+#endif
+
+static CARD32
+setup_int_vect(void)
+{
+ const CARD16 cs = 0x0;
+ const CARD16 ip = 0x0;
+ int i;
+
+ /* let the int vects point to the SYS_BIOS seg */
+ for (i=0; i<0x80; i++) {
+ ((CARD16*)0)[i<<1] = ip;
+ ((CARD16*)0)[(i<<1)+1] = cs;
+ }
+ /* video interrupts default location */
+ ((CARD16*)0)[(0x42<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x42<<1] = 0xf065;
+ ((CARD16*)0)[(0x10<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x10<<1] = 0xf065;
+ /* video param table default location (int 1d) */
+ ((CARD16*)0)[(0x1d<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x1d<<1] = 0xf0A4;
+ /* font tables default location (int 1F) */
+ ((CARD16*)0)[(0x1f<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x1f<<1] = 0xfa6e;
+
+ /* int 11 default location */
+ ((CARD16*)0)[(0x11<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x11<<1] = 0xf84d;
+ /* int 12 default location */
+ ((CARD16*)0)[(0x12<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x12<<1] = 0xf841;
+ /* int 15 default location */
+ ((CARD16*)0)[(0x15<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x15<<1] = 0xf859;
+ /* int 1A default location */
+ ((CARD16*)0)[(0x1a<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x1a<<1] = 0xff6e;
+ /* int 05 default location */
+ ((CARD16*)0)[(0x05<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x05<<1] = 0xff54;
+ /* int 08 default location */
+ ((CARD16*)0)[(0x8<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x8<<1] = 0xfea5;
+ /* int 13 default location (fdd) */
+ ((CARD16*)0)[(0x13<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x13<<1] = 0xec59;
+ /* int 0E default location */
+ ((CARD16*)0)[(0xe<<1)+1] = 0xf000;
+ ((CARD16*)0)[0xe<<1] = 0xef57;
+ /* int 17 default location */
+ ((CARD16*)0)[(0x17<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x17<<1] = 0xefd2;
+ /* fdd table default location (int 1e) */
+ ((CARD16*)0)[(0x1e<<1)+1] = 0xf000;
+ ((CARD16*)0)[0x1e<<1] = 0xefc7;
+ return V_BIOS;
+}
+
+static int
+setup_system_bios(void)
+{
+ char *date = "06/01/99";
+ char *eisa_ident = "PCI/ISA";
+
+ if (Config.MapSysBios) {
+
+ if (!copy_sys_bios()) return 0;
+ return 1;
+
+ } else {
+
+// memset((void *)0xF0000,0xf4,0xfff7);
+
+ /*
+ * we trap the "industry standard entry points" to the BIOS
+ * and all other locations by filling them with "hlt"
+ * TODO: implement hlt-handler for these
+ */
+ memset((void *)0xF0000,0xf4,0x10000);
+
+ /*
+ * TODO: we should copy the fdd table (0xfec59-0xfec5b)
+ * the video parameter table (0xf0ac-0xf0fb)
+ * and the font tables (0xfa6e-0xfe6d)
+ * from the original bios here
+ */
+
+ /* set bios date */
+ strcpy((char *)0xFFFF5,date);
+ /* set up eisa ident string */
+ strcpy((char *)0xFFFD9,eisa_ident);
+ /* write system model id for IBM-AT */
+ ((char *)0)[0xFFFFE] = 0xfc;
+
+ return 1;
+ }
+
+}
+
+static void
+update_bios_vars(void)
+{
+ int mem_fd;
+ void *map;
+ memType i;
+
+#ifdef __ia64__
+ if ((mem_fd = open(MEM_FILE,O_RDWR | O_SYNC))<0)
+#else
+ if ((mem_fd = open(MEM_FILE,O_RDWR))<0)
+#endif
+ {
+ perror("opening memory");
+ return;
+ }
+
+ if ((map = mmap((void *) 0, (size_t) 0x2000,
+ PROT_EXEC | PROT_READ | PROT_WRITE, MAP_SHARED,
+ mem_fd, 0)) == (void *)-1) {
+ perror("mmap error in map_hardware_ram (3)");
+ close(mem_fd);
+ return;
+ }
+
+ for (i = 0; i < BIOS_MEM; i++) {
+ if (bios_var[i] != *(CARD8*)i)
+ *((CARD8*)map + i) = *(CARD8*)i;
+ }
+
+ munmap(map,0x2000);
+ close(mem_fd);
+}
+
+static int
+chksum(CARD8 *start)
+{
+ CARD16 size;
+ CARD8 val = 0;
+ int i;
+
+ size = *(start+2) * 512;
+ for (i = 0; i<size; i++)
+ val += *(start + i);
+
+ if (!val)
+ return 1;
+
+ fprintf(stderr,"BIOS cksum wrong!\n");
+ return 0;
+}
+
+void
+runINT(int num, i86biosRegsPtr Regs)
+{
+ Bool isVideo = FALSE;
+ CARD8 code_int[] = { 3, 0xcd, 0x00, 0xf4 };
+
+ code_int[2] = (CARD8) num;
+
+ if (num == 0x10)
+ isVideo = TRUE;
+
+ if (!setup_system_bios())
+ return;
+
+ if ((isVideo && (!CurrentPci || CurrentPci->active)) || !isVideo) {
+ CARD32 vbios_base;
+
+#ifdef __ia32__
+ if (!(vbios_base = setup_primary_int_vect()))
+#else
+ if (!(vbios_base = setup_int_vect()))
+#endif
+ return;
+ if (!copy_vbios(vbios_base))
+ return;
+ }
+
+ if (!map_vram())
+ return;
+
+#ifdef V86BIOS_DEBUG
+ printf("starting BIOS\n");
+#endif
+ loadCodeToMem((unsigned char *) BIOS_START, code_int);
+ setup_io();
+ print_regs(Regs);
+ set_ioperm();
+ set_hlt(TRUE);
+ do_x86(BIOS_START,Regs);
+ set_hlt(FALSE);
+ print_regs(Regs);
+
+#ifdef V86BIOS_DEBUG
+ printf("done\n");
+#endif
+
+ if ((isVideo && (!CurrentPci || CurrentPci->active)) || !isVideo)
+ update_bios_vars();
+}
+
+static void
+print_regs(i86biosRegsPtr regs)
+{
+ printf("ax=%x bx=%x cx=%x dx=%x ds=%x es=%x di=%x si=%x\n",
+ (CARD16)regs->ax,(CARD16)regs->bx,(CARD16)regs->cx,(CARD16)regs->dx,
+ (CARD16)regs->ds,(CARD16)regs->es,(CARD16)regs->di,
+ (CARD16)regs->si);
+}
+
+static void
+print_usage(void)
+{
+}
+
+void
+add_hlt(unsigned long val)
+{
+ int i;
+
+ if (val < BIOS_MEM || (val > VRAM_START && val < (VRAM_START + VRAM_SIZE))
+ || val >= SIZE) {
+ printf("address out of range\n");
+ return;
+ }
+
+ for (i=0; i<20; i++) {
+ if (hltp[i].address == 0) {
+ hltp[i].address = (void*)val;
+ break;
+ }
+ }
+ if (i == 20) printf("no more hltpoints available\n");
+}
+
+void
+del_hlt(int val)
+{
+ if (val == 21) { /* delete all */
+ int i;
+ printf("clearing all hltpoints\n");
+ for (i=0; i <20; i++)
+ hltp[i].address = NULL;
+ } else if (val >= 0 && val <20)
+ hltp[val].address = NULL;
+ else printf("hltpoint %i out of range: valid range 0-19\n",val);
+}
+
+void
+list_hlt()
+{
+ int i;
+ for (i=0; i<20; i++)
+ if (hltp[i].address)
+ printf("hltpoint[%i]: 0x%lx\n",i,(unsigned long)hltp[i].address);
+}
+
+static void
+set_hlt(Bool set)
+{
+ int i;
+ for (i=0; i<20; i++)
+ if (hltp[i].address) {
+ if (set) {
+ hltp[i].orgval = *(CARD8*)hltp[i].address;
+ *(CARD8*)hltp[i].address = 0xf4;
+ } else
+ *(CARD8*)hltp[i].address = hltp[i].orgval;
+ }
+}
+
+static void
+set_ioperm(void)
+{
+ int i, start;
+
+ ioperm(0,IOPERM_BITS,0);
+
+ for (i = 0; i < IOPERM_BITS;i++)
+ if (ioperm_list[i]) {
+ start = i;
+ for (;i < IOPERM_BITS; i++) {
+ if (!ioperm_list[i]) {
+ ioperm(start,i - start, 1);
+ break;
+ }
+ }
+ }
+}
OpenPOWER on IntegriCloud