added testbios for V2
[coreboot.git] / util / vgabios / helper_mem.c
diff --git a/util/vgabios/helper_mem.c b/util/vgabios/helper_mem.c
new file mode 100644 (file)
index 0000000..be53598
--- /dev/null
@@ -0,0 +1,311 @@
+/* $XFree86: xc/programs/Xserver/hw/xfree86/int10/helper_mem.c,v 1.21 2001/05/22 16:24:37 tsi Exp $ */
+/*
+ *                   XFree86 int10 module
+ *   execute BIOS int 10h calls in x86 real mode environment
+ *                 Copyright 1999 Egbert Eich
+ */
+#define _INT10_PRIVATE
+
+#define REG pInt
+#if 0
+typedef enum {
+       OPT_NOINT10,
+       OPT_INIT_PRIMARY,
+       OPT_BIOS_LOCATION
+} INT10Opts;
+
+static const OptionInfoRec INT10Options[] = {
+       {OPT_NOINT10, "NoINT10", OPTV_BOOLEAN, {0}, FALSE},
+       {OPT_INIT_PRIMARY, "InitPrimary", OPTV_BOOLEAN, {0}, FALSE},
+       {OPT_BIOS_LOCATION, "BiosLocation", OPTV_STRING, {0}, FALSE},
+       {-1, NULL, OPTV_NONE, {0}, FALSE},
+};
+#endif
+
+#ifdef DEBUG
+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", ((((u8) (*c)) > 32) && (((u8) (*c)) < 128)) ?
+                              (unsigned char) (*(c)) : '.');
+                       c++;
+               }
+       }
+       printf("\n");
+}
+#endif /* DEBUG */
+
+#if 0
+#ifndef _PC
+/*
+ * here we are really paranoid about faking a "real"
+ * BIOS. Most of this information was pulled from
+ * dosemu.
+ */
+void setup_int_vect(void)
+{
+       int i;
+
+       /* let the int vects point to the SYS_BIOS seg */
+       for (i = 0; i < 0x80; i++) {
+               MEM_WW(i << 2, 0);
+               MEM_WW((i << 2) + 2, SYS_BIOS >> 4);
+       }
+
+       reset_int_vect(current);
+       /* font tables default location (int 1F) */
+       MEM_WW(0x1f << 2, 0xfa6e);
+
+       /* int 11 default location (Get Equipment Configuration) */
+       MEM_WW(0x11 << 2, 0xf84d);
+       /* int 12 default location (Get Conventional Memory Size) */
+       MEM_WW(0x12 << 2, 0xf841);
+       /* int 15 default location (I/O System Extensions) */
+       MEM_WW(0x15 << 2, 0xf859);
+       /* int 1A default location (RTC, PCI and others) */
+       MEM_WW(0x1a << 2, 0xff6e);
+       /* int 05 default location (Bound Exceeded) */
+       MEM_WW(0x05 << 2, 0xff54);
+       /* int 08 default location (Double Fault) */
+       MEM_WW(0x08 << 2, 0xfea5);
+       /* int 13 default location (Disk) */
+       MEM_WW(0x13 << 2, 0xec59);
+       /* int 0E default location (Page Fault) */
+       MEM_WW(0x0e << 2, 0xef57);
+       /* int 17 default location (Parallel Port) */
+       MEM_WW(0x17 << 2, 0xefd2);
+       /* fdd table default location (int 1e) */
+       MEM_WW(0x1e << 2, 0xefc7);
+
+       /* Set Equipment flag to VGA */
+       i = MEM_RB(0x0410) & 0xCF;
+       MEM_WB(0x0410, i);
+       /* XXX Perhaps setup more of the BDA here.  See also int42(0x00). */
+}
+#endif
+
+int setup_system_bios(void *base_addr)
+{
+       char *base = (char *) base_addr;
+
+       /*
+        * 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(base, 0xf4, 0x10000);
+
+       /* set bios date */
+       strcpy(base + 0x0FFF5, "06/11/99");
+       /* set up eisa ident string */
+       strcpy(base + 0x0FFD9, "PCI_ISA");
+       /* write system model id for IBM-AT */
+       *((unsigned char *) (base + 0x0FFFE)) = 0xfc;
+
+       return 1;
+}
+
+void reset_int_vect(void)
+{
+       /*
+        * This table is normally located at 0xF000:0xF0A4.  However, int 0x42,
+        * function 0 (Mode Set) expects it (or a copy) somewhere in the bottom
+        * 64kB.  Note that because this data doesn't survive POST, int 0x42 should
+        * only be used during EGA/VGA BIOS initialisation.
+        */
+       static const u8 VideoParms[] = {
+               /* Timing for modes 0x00 & 0x01 */
+               0x38, 0x28, 0x2d, 0x0a, 0x1f, 0x06, 0x19, 0x1c,
+               0x02, 0x07, 0x06, 0x07, 0x00, 0x00, 0x00, 0x00,
+               /* Timing for modes 0x02 & 0x03 */
+               0x71, 0x50, 0x5a, 0x0a, 0x1f, 0x06, 0x19, 0x1c,
+               0x02, 0x07, 0x06, 0x07, 0x00, 0x00, 0x00, 0x00,
+               /* Timing for modes 0x04, 0x05 & 0x06 */
+               0x38, 0x28, 0x2d, 0x0a, 0x7f, 0x06, 0x64, 0x70,
+               0x02, 0x01, 0x06, 0x07, 0x00, 0x00, 0x00, 0x00,
+               /* Timing for mode 0x07 */
+               0x61, 0x50, 0x52, 0x0f, 0x19, 0x06, 0x19, 0x19,
+               0x02, 0x0d, 0x0b, 0x0c, 0x00, 0x00, 0x00, 0x00,
+               /* Display page lengths in little endian order */
+               0x00, 0x08,     /* Modes 0x00 and 0x01 */
+               0x00, 0x10,     /* Modes 0x02 and 0x03 */
+               0x00, 0x40,     /* Modes 0x04 and 0x05 */
+               0x00, 0x40,     /* Modes 0x06 and 0x07 */
+               /* Number of columns for each mode */
+               40, 40, 80, 80, 40, 40, 80, 80,
+               /* CGA Mode register value for each mode */
+               0x2c, 0x28, 0x2d, 0x29, 0x2a, 0x2e, 0x1e, 0x29,
+               /* Padding */
+               0x00, 0x00, 0x00, 0x00
+       };
+       int i;
+
+       for (i = 0; i < sizeof(VideoParms); i++)
+               MEM_WB(i + (0x1000 - sizeof(VideoParms)), VideoParms[i]);
+       MEM_WW(0x1d << 2, 0x1000 - sizeof(VideoParms));
+       MEM_WW((0x1d << 2) + 2, 0);
+
+       printf("SETUP INT\n");
+       MEM_WW(0x10 << 2, 0xf065);
+       MEM_WW((0x10 << 2) + 2, SYS_BIOS >> 4);
+       MEM_WW(0x42 << 2, 0xf065);
+       MEM_WW((0x42 << 2) + 2, SYS_BIOS >> 4);
+       MEM_WW(0x6D << 2, 0xf065);
+       MEM_WW((0x6D << 2) + 2, SYS_BIOS >> 4);
+}
+
+void set_return_trap(void)
+{
+       /*
+        * Here we set the exit condition:  We return when we encounter
+        * 'hlt' (=0xf4), which we locate at address 0x600 in x86 memory.
+        */
+       MEM_WB(0x0600, 0xf4);
+
+       /*
+        * Allocate a segment for the stack
+        */
+       xf86Int10AllocPages(1, current->stackseg);
+}
+
+void *xf86HandleInt10Options(ScrnInfoPtr pScrn, int entityIndex)
+{
+       EntityInfoPtr pEnt = xf86GetEntityInfo(entityIndex);
+       OptionInfoPtr options = NULL;
+
+       if (pEnt->device) {
+               pointer configOptions = NULL;
+
+               /* Check if xf86CollectOptions() has already been called */
+               if (((pEnt->index < 0) ||
+                    !xf86Screens[pEnt->index] ||
+                    !(configOptions = xf86Screens[pEnt->index]->options)) &&
+                   pEnt->device)
+                       configOptions = pEnt->device->options;
+
+               if (configOptions) {
+                       if (!(options = (OptionInfoPtr) xalloc(sizeof(INT10Options))))
+                               return NULL;
+
+                       (void) memcpy(options, INT10Options, sizeof(INT10Options));
+                       xf86ProcessOptions(pScrn->scrnIndex, configOptions, options);
+               }
+       }
+       xfree(pEnt);
+
+       return options;
+}
+
+Bool int10skip(void *options)
+{
+       Bool noint10 = FALSE;
+
+       if (!options)
+               return FALSE;
+
+       xf86GetOptValBool(options, OPT_NOINT10, &noint10);
+       return noint10;
+}
+
+Bool int10_check_bios(int scrnIndex, int codeSeg, unsigned char *vbiosMem)
+{
+       int size;
+
+       if ((codeSeg & 0x1f) || /* Not 512-byte aligned otherwise */
+           ((codeSeg << 4) < V_BIOS) || ((codeSeg << 4) >= SYS_SIZE))
+               return FALSE;
+
+       if (xf86IsPc98())
+               return FALSE;
+
+       if ((*vbiosMem != 0x55) || (*(vbiosMem + 1) != 0xAA) || !*(vbiosMem + 2))
+               return FALSE;
+
+       size = *(vbiosMem + 2) * 512;
+
+       if ((size + (codeSeg << 4)) > SYS_SIZE)
+               return FALSE;
+
+       if (bios_checksum(vbiosMem, size))
+               xf86DrvMsg(scrnIndex, X_WARNING, "Bad V_BIOS checksum\n");
+
+       return TRUE;
+}
+
+Bool initPrimary(void *options)
+{
+       Bool initPrimary = FALSE;
+
+       if (!options)
+               return FALSE;
+
+       xf86GetOptValBool(options, OPT_INIT_PRIMARY, &initPrimary);
+       return initPrimary;
+}
+
+void xf86int10ParseBiosLocation(void *options, xf86int10BiosLocationPtr bios)
+{
+       char *s;
+       char *p;
+       char *str = NULL;
+
+       if (options)
+               str = xf86GetOptValString(options, OPT_BIOS_LOCATION);
+
+       bios->bus = BUS_NONE;
+       if (!str)
+               return;
+
+       s = xstrdup(str);
+       p = strtok(s, ":");
+       if (xf86NameCmp(p, "pci"))
+               bios->bus = BUS_PCI;
+       else if (xf86NameCmp(p, "primary"))
+               bios->bus = BUS_ISA;
+
+       xfree(s);
+
+       if (bios->bus == BUS_NONE)
+               return;
+
+       s = xstrdup(str);
+       p = strchr(s, ':');
+
+       switch (bios->bus) {
+       case BUS_ISA:
+               if (p)
+                       bios->location.legacy = atoi(++p);
+               else
+                       bios->location.legacy = 0;
+               break;
+       case BUS_PCI:
+               if (p) {
+                       bios->location.pci.bus = atoi(++p);
+                       if ((p = strchr(p, ':'))) {
+                               bios->location.pci.dev = atoi(++p);
+                               if ((p = strchr(p, ':'))) {
+                                       bios->location.pci.func = atoi(++p);
+                                       break;
+                               }
+                       }
+               }
+               /* fall through */
+               bios->bus = BUS_NONE;
+               break;
+       default:
+               break;
+       }
+       xfree(s);
+}
+
+
+#endif