fix a couple of warnings

[coreboot.git] / src / mainboard / kontron / 986lcd-m / mainboard.c

diff --git a/src/mainboard/kontron/986lcd-m/mainboard.c b/src/mainboard/kontron/986lcd-m/mainboard.c
index 9a2a5fdc5cc3d62ed5dd5271b51a9863ae4cbc77..180df992e625b333462b80b527fe846ac5424020 100644 (file)
--- a/src/mainboard/kontron/986lcd-m/mainboard.c
+++ b/src/mainboard/kontron/986lcd-m/mainboard.c
@@ -3,10 +3,9 @@
  *
  * Copyright (C) 2007-2009 coresystems GmbH
  *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License as
- * published by the Free Software Foundation; version 2 of
- * the License.
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; version 2 of the License.
  *
  * This program is distributed in the hope that it will be useful,
  * but WITHOUT ANY WARRANTY; without even the implied warranty of
@@ -15,25 +14,69 @@
  *
  * You should have received a copy of the GNU General Public License
  * along with this program; if not, write to the Free Software
- * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
- * MA 02110-1301 USA
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
  */
 
 #include <types.h>
 #include <device/device.h>
 #include <console/console.h>
 #include <boot/tables.h>
+#if CONFIG_PCI_OPTION_ROM_RUN_YABEL
+#include <x86emu/x86emu.h>
+#endif
 #include <pc80/mc146818rtc.h>
 #include <arch/io.h>
+#include <arch/coreboot_tables.h>
 #include "chip.h"
 
-int add_northbridge_resources(struct lb_memory *mem);
-
 int add_mainboard_resources(struct lb_memory *mem)
 {
        return add_northbridge_resources(mem);
 }
 
+#if CONFIG_PCI_OPTION_ROM_RUN_YABEL
+static int int15_handler(void)
+{
+#define BOOT_DISPLAY_DEFAULT   0
+#define BOOT_DISPLAY_CRT       (1 << 0)
+#define BOOT_DISPLAY_TV                (1 << 1)
+#define BOOT_DISPLAY_EFP       (1 << 2)
+#define BOOT_DISPLAY_LCD       (1 << 3)
+#define BOOT_DISPLAY_CRT2      (1 << 4)
+#define BOOT_DISPLAY_TV2       (1 << 5)
+#define BOOT_DISPLAY_EFP2      (1 << 6)
+#define BOOT_DISPLAY_LCD2      (1 << 7)
+
+       printk_debug("%s: AX=%04x BX=%04x CX=%04x DX=%04x\n",
+                         __func__, M.x86.R_AX, M.x86.R_BX, M.x86.R_CX, M.x86.R_DX);
+
+       switch (M.x86.R_AX) {
+       case 0x5f35: /* Boot Display */
+               M.x86.R_AX = 0x005f; // Success
+               M.x86.R_CL = BOOT_DISPLAY_DEFAULT;
+               break;
+       case 0x5f40: /* Boot Panel Type */
+               // M.x86.R_AX = 0x015f; // Supported but failed
+               M.x86.R_AX = 0x005f; // Success
+               M.x86.R_CL = 3; // Display ID
+               break;
+       default:
+               /* Interrupt was not handled */
+               return 0;
+       }
+
+       /* Interrupt handled */
+       return 1;
+}
+
+static void int15_install(void)
+{
+       typedef int (* yabel_handleIntFunc)(void);
+       extern yabel_handleIntFunc yabel_intFuncArray[256];
+       yabel_intFuncArray[0x15] = int15_handler;
+}
+#endif
+
 /* Hardware Monitor */
 
 static u16 hwm_base = 0xa00;
@@ -182,8 +225,13 @@ static void verb_setup(void)
 
 // mainboard_enable is executed as first thing after 
 // enumerate_buses().
+
 static void mainboard_enable(device_t dev) 
 {
+#if CONFIG_PCI_OPTION_ROM_RUN_YABEL
+       /* Install custom int15 handler for VGA OPROM */
+       int15_install();
+#endif
        verb_setup();
        hwm_setup();
 }