init commit via android 4.4 uboot

1 files changed, 616 insertions, 0 deletions

diff --git a/board/MAI/bios_emulator/scitech/src/v86bios/main.c b/board/MAI/bios_emulator/scitech/src/v86bios/main.c
new file mode 100755
index 0000000..15f9115
--- /dev/null
+++ b/board/MAI/bios_emulator/scitech/src/v86bios/main.c
@@ -0,0 +1,616 @@
+/*
+ * 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;
+}