Author: stepan Date: 2010-01-19 22:15:01 +0100 (Tue, 19 Jan 2010) New Revision: 5042
Modified: trunk/src/mainboard/kontron/986lcd-m/mainboard.c Log:
Add Yabel support (int 15 5fXX callbacks for vga bios) on the kontron 986lcd-m so it's possible to use the LCD panel connector. Values are hard coded instead of read from CMOS but it's a start.
Signed-off-by: Stefan Reinauer stepan@coresystems.de Acked-by: Peter Stuge peter@stuge.se
Modified: trunk/src/mainboard/kontron/986lcd-m/mainboard.c =================================================================== --- trunk/src/mainboard/kontron/986lcd-m/mainboard.c 2010-01-19 21:14:24 UTC (rev 5041) +++ trunk/src/mainboard/kontron/986lcd-m/mainboard.c 2010-01-19 21:15:01 UTC (rev 5042) @@ -23,6 +23,7 @@ #include <device/device.h> #include <console/console.h> #include <boot/tables.h> +#include <x86emu/x86emu.h> #include <pc80/mc146818rtc.h> #include <arch/io.h> #include "chip.h" @@ -34,6 +35,49 @@ 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 +226,13 @@
// 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(); }