| /* |
| * 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> |
| #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 */ |
| |
| /*CARD8 code[] = { 0xb8 , 0xf0 , 0xf0, 0xf4 }; */ |
| #define VB_X(x) (V_BIOS >> x) & 0xFF |
| CARD8 code[] = { 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 }; */ |
| |
| 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(void); |
| static int copy_sys_bios(void); |
| static void save_bios_to_file(void); |
| static int setup_system_bios(void); |
| static void setup_int_vect(void); |
| static int chksum(CARD8 *start); |
| static void setup_bios_regs(i86biosRegsPtr regs, CARD32 ax); |
| |
| void loadCodeToMem(unsigned char *ptr, CARD8 *code); |
| void dprint(unsigned long start, unsigned long size); |
| |
| static int vram_mapped = 0; |
| static CARD8 save_msr; |
| static CARD8 save_pos102; |
| static CARD8 save_vse; |
| static CARD8 save_46e8; |
| console Console; |
| struct config Config; |
| |
| |
| int |
| main(void) |
| { |
| int Active_is_Pci = 0; |
| #ifdef DELETE |
| 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; |
| Config.ConfigActiveDevice = CONFIG_ACTIVE_DEVICE; |
| Config.MapSysBios = MAP_SYS_BIOS; |
| Config.Resort = RESORT; |
| Config.FixRom = FIX_ROM; |
| Config.NoConsole = NO_CONSOLE; |
| Config.Verbose = VERBOSE; |
| |
| if (!map()) |
| exit(1); |
| |
| if (!setup_system_bios()) |
| exit(1); |
| |
| iopl(3); |
| setup_io(); |
| |
| scan_pci(); |
| if (!CurrentPci && !Config.ConfigActiveDevice && !Config.ConfigActiveOnly) |
| exit (1); |
| #endif |
| Console = open_console(); |
| |
| if (Config.ConfigActiveOnly) { |
| CARD16 ax; |
| int activePci = 0; |
| int error = 0; |
| |
| while (CurrentPci) { |
| if (CurrentPci->active) { |
| activePci = 1; |
| if (!(mapPciRom(NULL) && chksum((CARD8*)V_BIOS))) |
| error = 1; |
| break; |
| } |
| CurrentPci = CurrentPci->next; |
| } |
| ax = ((CARD16)(CurrentPci->bus) << 8) |
| | (CurrentPci->dev << 3) | (CurrentPci->func & 0x7); |
| P_printf("ax: 0x%x\n",ax); |
| setup_int_vect(); |
| if (!error && (activePci || copy_vbios())) { |
| |
| if (Config.SaveBios) save_bios_to_file(); |
| if (map_vram()) { |
| printf("initializing ISA\n"); |
| bootBIOS(0); |
| } |
| } |
| unmap_vram(); |
| sleep(1); |
| } else { |
| /* disable primary card */ |
| save_msr = inb(0x3CC); |
| save_vse = inb(0x3C3); |
| save_46e8 = inb(0x46e8); |
| save_pos102 = inb(0x102); |
| |
| signal(2,sig_handler); |
| signal(11,sig_handler); |
| |
| 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) { |
| 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 */ |
| setup_int_vect(); |
| |
| ax = ((CARD16)(CurrentPci->bus) << 8) |
| | (CurrentPci->dev << 3) | (CurrentPci->func & 0x7); |
| P_printf("ax: 0x%x\n",ax); |
| |
| if (!((mapPciRom(NULL) && chksum((CARD8*)V_BIOS)) |
| || (CurrentPci->active && copy_vbios()))) { |
| 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(); |
| |
| CurrentPci = CurrentPci->next; |
| } |
| |
| /* We have an ISA device - configure if requested */ |
| if (!Active_is_Pci && Config.ConfigActiveDevice) { |
| pciVideoDisable(); |
| |
| outb(0x102, save_pos102); |
| outb(0x46e8, save_46e8); |
| outb(0x3C3, save_vse); |
| outb(0x3C2, save_msr); |
| |
| setup_int_vect(); |
| if (copy_vbios()) { |
| |
| if (Config.SaveBios) save_bios_to_file(); |
| if (map_vram()) { |
| printf("initializing ISA\n"); |
| bootBIOS(0); |
| } |
| } |
| |
| unmap_vram(); |
| sleep(1); |
| } |
| |
| pciVideoRestore(); |
| |
| outb(0x102, save_pos102); |
| outb(0x46e8, save_46e8); |
| outb(0x3C3, save_vse); |
| outb(0x3C2, save_msr); |
| } |
| |
| close_console(Console); |
| #ifdef DELETE |
| iopl(0); |
| unmap(); |
| |
| printf("done !\n"); |
| #endif |
| if (Config.IoStatistics) |
| io_statistics(); |
| #ifdef DELETE |
| exit(0); |
| #endif |
| } |
| |
| 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); |
| |
| loadCodeToMem((unsigned char *) BIOS_START, code); |
| 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_bios_regs(&bRegs, ax); |
| 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; |
| } |
| |
| #ifndef __alpha__ |
| 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) |
| #else |
| 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) |
| #endif |
| { |
| perror("mmap error in map_hardware_ram"); |
| 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(void) |
| { |
| 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_BIOS, SEEK_SET) != (off_t) V_BIOS) { |
| 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_BIOS,SEEK_SET) != (off_t) V_BIOS) |
| goto Error; |
| |
| if (*tmp != 0x55 || *(tmp+1) != 0xAA ) { |
| #ifdef DEBUG |
| dprint((unsigned long)tmp,0x100); |
| #endif |
| fprintf(stderr,"No bios found at: 0x%x\n",V_BIOS); |
| goto Error; |
| } |
| size = *(tmp+2) * 512; |
| |
| if (read(mem_fd, (char *)V_BIOS, (size_t) size) != (size_t) size) { |
| fprintf(stderr,"Cannot read\n"); |
| goto Error; |
| } |
| free(tmp); |
| close(mem_fd); |
| if (!chksum((CARD8)V_BIOS)) |
| 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; |
| |
| for ( i=0;;i++) { |
| val = code[i]; |
| *ptr++ = val; |
| if (val == 0xf4) break; |
| } |
| 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->di = 0; |
| } |
| |
| /* |
| * here we are really paranoid about faking a "real" |
| * BIOS. Most of this information was pulled from |
| * dosem. |
| */ |
| static void |
| setup_int_vect(void) |
| { |
| const CARD16 cs = 0x0000; |
| 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; |
| } |
| |
| static int |
| setup_system_bios(void) |
| { |
| char *date = "06/01/99"; |
| char *eisa_ident = "PCI/ISA"; |
| |
| #if MAP_SYS_BIOS |
| if (!copy_sys_bios()) return 0; |
| return 1; |
| #endif |
| /* 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 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; |
| } |