X-Git-Url: http://wien.tomnetworks.com/gitweb/?a=blobdiff_plain;f=src%2Fvgahooks.c;h=20a2e2e2947bd7f48ac822b5adac0322f23d2a3c;hb=02145150f64d4fcb9e122bc7fcc11c23fbbe9fbc;hp=8f55c49c669057c70176c2a284e99a481d2c0fa9;hpb=4735877249b30502e4c816bf1dc1a2c0e16be68e;p=seabios.git diff --git a/src/vgahooks.c b/src/vgahooks.c index 8f55c49..20a2e2e 100644 --- a/src/vgahooks.c +++ b/src/vgahooks.c @@ -2,17 +2,36 @@ // // Copyright (C) 2008 Kevin O'Connor // -// This file may be distributed under the terms of the GNU GPLv3 license. +// This file may be distributed under the terms of the GNU LGPLv3 license. -#include "bregs.h" // set_code_fail +#include "bregs.h" // set_code_invalid #include "biosvar.h" // GET_GLOBAL #include "pci.h" // pci_find_device +#include "pci_regs.h" // PCI_VENDOR_ID #include "pci_ids.h" // PCI_VENDOR_ID_VIA #include "util.h" // handle_155f #include "config.h" // CONFIG_* +#define VH_VIA 1 +#define VH_INTEL 2 + +int VGAHookHandlerType VAR16VISIBLE; + +static void +handle_155fXX(struct bregs *regs) +{ + set_code_unimplemented(regs, RET_EUNSUPPORTED); +} + + +/**************************************************************** + * Via hooks + ****************************************************************/ + +int ViaFBsize VAR16VISIBLE, ViaRamSpeed VAR16VISIBLE; + static void -handle_155f01(struct bregs *regs) +via_155f01(struct bregs *regs) { regs->eax = 0x5f; regs->cl = 2; // panel type = 2 = 1024 * 768 @@ -21,7 +40,7 @@ handle_155f01(struct bregs *regs) } static void -handle_155f02(struct bregs *regs) +via_155f02(struct bregs *regs) { regs->eax = 0x5f; regs->bx = 2; @@ -31,41 +50,68 @@ handle_155f02(struct bregs *regs) dprintf(1, "Warning: VGA TV/CRT output type is hardcoded\n"); } -static int -getFBSize() +static void +via_155f18(struct bregs *regs) +{ + int fbsize = GET_GLOBAL(ViaFBsize), ramspeed = GET_GLOBAL(ViaRamSpeed); + if (fbsize < 0 || ramspeed < 0) { + set_code_invalid(regs, RET_EUNSUPPORTED); + return; + } + regs->eax = 0x5f; + regs->ebx = 0x500 | (ramspeed << 4) | fbsize; + regs->ecx = 0x060; + set_success(regs); +} + +static void +via_155f19(struct bregs *regs) +{ + set_invalid_silent(regs); +} + +static void +via_155f(struct bregs *regs) { - /* Find K8M890 */ - int bdf = pci_find_device(PCI_VENDOR_ID_VIA, 0x3336); - if (bdf < 0) - goto err; + switch (regs->al) { + case 0x01: via_155f01(regs); break; + case 0x02: via_155f02(regs); break; + case 0x18: via_155f18(regs); break; + case 0x19: via_155f19(regs); break; + default: handle_155fXX(regs); break; + } +} +static int +getFBSize(struct pci_device *pci) +{ /* FB config */ - u8 reg = pci_config_readb(bdf, 0xa1); + u8 reg = pci_config_readb(pci->bdf, 0xa1); /* GFX disabled ? */ if (!(reg & 0x80)) - goto err; + return -1; static u8 mem_power[] = {0, 3, 4, 5, 6, 7, 8, 9}; - return GET_GLOBAL(mem_power[(reg >> 4) & 0x7]); -err: - dprintf(1, "Warning: VGA memory size is hardcoded\n"); - return 5; // 32M frame buffer + return mem_power[(reg >> 4) & 0x7]; } static int -getRamSpeed() +getViaRamSpeed(struct pci_device *pci) { - int bdf = pci_find_device(PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_K8_NB_MEMCTL); - if (bdf < 0) - goto err; + return (pci_config_readb(pci->bdf, 0x90) & 0x07) + 3; +} + +static int +getAMDRamSpeed(void) +{ + struct pci_device *pci = pci_find_device(PCI_VENDOR_ID_AMD + , PCI_DEVICE_ID_AMD_K8_NB_MEMCTL); + if (!pci) + return -1; /* mem clk 0 = DDR2 400 */ - u8 reg = pci_config_readb(bdf, 0x94) & 0x7; - return reg + 6; -err: - dprintf(1, "Warning: VGA memory clock speed is hardcoded\n"); - return 4; // MCLK = DDR266 + return (pci_config_readb(pci->bdf, 0x94) & 0x7) + 6; } /* int 0x15 - 5f18 @@ -87,46 +133,156 @@ err: B: and above: Unknown EBX[?..8] Total memory size? EAX = 0x5f for success - - K8M890 BIOS wants only this call (Desktop NoTv) */ +#define PCI_DEVICE_ID_VIA_K8M890CE_3 0x3336 +#define PCI_DEVICE_ID_VIA_VX855_MEMCTRL 0x3409 + static void -handle_155f18(struct bregs *regs) +via_setup(struct pci_device *pci) { - regs->eax = 0x5f; - u32 ramspeed = getRamSpeed(); - u32 fbsize = getFBSize(); - regs->ebx = 0x500 | (ramspeed << 4) | fbsize; - regs->ecx = 0x060; + VGAHookHandlerType = VH_VIA; + + struct pci_device *d = pci_find_device(PCI_VENDOR_ID_VIA + , PCI_DEVICE_ID_VIA_K8M890CE_3); + if (d) { + ViaFBsize = getFBSize(d); + ViaRamSpeed = getAMDRamSpeed(); + return; + } + d = pci_find_device(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_VX855_MEMCTRL); + if (d) { + ViaFBsize = getFBSize(d); + ViaRamSpeed = getViaRamSpeed(d); + return; + } + + dprintf(1, "Warning: VGA memory size and speed is hardcoded\n"); + ViaFBsize = 5; // 32M frame buffer + ViaRamSpeed = 4; // MCLK = DDR266 +} + + +/**************************************************************** + * Intel VGA hooks + ****************************************************************/ + +u8 IntelDisplayType VAR16VISIBLE, IntelDisplayId VAR16VISIBLE; + +static void +intel_155f35(struct bregs *regs) +{ + regs->ax = 0x005f; + regs->cl = GET_GLOBAL(IntelDisplayType); set_success(regs); } static void -handle_155f19(struct bregs *regs) +intel_155f40(struct bregs *regs) { - set_fail_silent(regs); + regs->ax = 0x005f; + regs->cl = GET_GLOBAL(IntelDisplayId); + set_success(regs); } static void -handle_155fXX(struct bregs *regs) +intel_155f50(struct bregs *regs) +{ + /* Mandatory hook on some Dell laptops */ + regs->ax = 0x005f; + set_success(regs); +} + +static void +intel_155f(struct bregs *regs) +{ + switch (regs->al) { + case 0x35: intel_155f35(regs); break; + case 0x40: intel_155f40(regs); break; + case 0x50: intel_155f50(regs); break; + default: handle_155fXX(regs); break; + } +} + +#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) + +static void +intel_setup(struct pci_device *pci) { - set_code_fail(regs, RET_EUNSUPPORTED); + VGAHookHandlerType = VH_INTEL; + + IntelDisplayType = BOOT_DISPLAY_DEFAULT; + IntelDisplayId = 3; +} + +static void +roda_setup(struct pci_device *pci) +{ + VGAHookHandlerType = VH_INTEL; + // IntelDisplayType = BOOT_DISPLAY_DEFAULT; + IntelDisplayType = BOOT_DISPLAY_LCD; + // IntelDisplayId = inb(0x60f) & 0x0f; // Correct according to Crete + IntelDisplayId = 3; // Correct according to empirical studies +} + +static void +kontron_setup(struct pci_device *pci) +{ + VGAHookHandlerType = VH_INTEL; + IntelDisplayType = BOOT_DISPLAY_CRT; + IntelDisplayId = 3; } +static void +getac_setup(struct pci_device *pci) +{ +} + + +/**************************************************************** + * Entry and setup + ****************************************************************/ + +// Main 16bit entry point void handle_155f(struct bregs *regs) { - if (! CONFIG_VGAHOOKS) { + if (!CONFIG_VGAHOOKS) { handle_155fXX(regs); return; } - switch (regs->al) { - case 0x01: handle_155f01(regs); break; - case 0x02: handle_155f02(regs); break; - case 0x18: handle_155f18(regs); break; - case 0x19: handle_155f19(regs); break; - default: handle_155fXX(regs); break; + int htype = GET_GLOBAL(VGAHookHandlerType); + switch (htype) { + case VH_VIA: via_155f(regs); break; + case VH_INTEL: intel_155f(regs); break; + default: handle_155fXX(regs); break; } } + +// Setup +void +vgahook_setup(struct pci_device *pci) +{ + if (!CONFIG_VGAHOOKS) + return; + + if (strcmp(CBvendor, "KONTRON") == 0 && strcmp(CBpart, "986LCD-M") == 0) + kontron_setup(pci); + else if (strcmp(CBvendor, "GETAC") == 0 && strcmp(CBpart, "P470") == 0) + getac_setup(pci); + else if (strcmp(CBvendor, "RODA") == 0 && strcmp(CBpart, "RK886EX") == 0) + roda_setup(pci); + else if (pci->vendor == PCI_VENDOR_ID_VIA) + via_setup(pci); + else if (pci->vendor == PCI_VENDOR_ID_INTEL) + intel_setup(pci); +}