qemu/roms/seabios/src/vgahooks.c

   1 // Hooks for via vgabios calls into main bios.
   2 //
   3 // Copyright (C) 2008  Kevin O'Connor <kevin@koconnor.net>
   4 //
   5 // This file may be distributed under the terms of the GNU LGPLv3 license.
   6
   7 #include "biosvar.h" // GET_GLOBAL
   8 #include "bregs.h" // set_code_invalid
   9 #include "config.h" // CONFIG_*
  10 #include "hw/pci.h" // pci_find_device
  11 #include "hw/pci_ids.h" // PCI_VENDOR_ID_VIA
  12 #include "hw/pci_regs.h" // PCI_VENDOR_ID
  13 #include "output.h" // dprintf
  14 #include "string.h" // strcmp
  15 #include "util.h" // handle_155f, handle_157f
  16
  17 #define VH_VIA 1
  18 #define VH_INTEL 2
  19 #define VH_SMI 3
  20
  21 int VGAHookHandlerType VARFSEG;
  22
  23 static void
  24 handle_155fXX(struct bregs *regs)
  25 {
  26     set_code_unimplemented(regs, RET_EUNSUPPORTED);
  27 }
  28
  29 static void
  30 handle_157fXX(struct bregs *regs)
  31 {
  32     set_code_unimplemented(regs, RET_EUNSUPPORTED);
  33 }
  34
  35 /****************************************************************
  36  * Via hooks
  37  ****************************************************************/
  38
  39 int ViaFBsize VARFSEG, ViaRamSpeed VARFSEG;
  40
  41 static void
  42 via_155f01(struct bregs *regs)
  43 {
  44     regs->eax = 0x5f;
  45     regs->cl = 2; // panel type =  2 = 1024 * 768
  46     set_success(regs);
  47     dprintf(1, "Warning: VGA panel type is hardcoded\n");
  48 }
  49
  50 static void
  51 via_155f02(struct bregs *regs)
  52 {
  53     regs->eax = 0x5f;
  54     regs->bx = 2;
  55     regs->cx = 0x401;  // PAL + crt only
  56     regs->dx = 0;  // TV Layout - default
  57     set_success(regs);
  58     dprintf(1, "Warning: VGA TV/CRT output type is hardcoded\n");
  59 }
  60
  61 static void
  62 via_155f18(struct bregs *regs)
  63 {
  64     int fbsize = GET_GLOBAL(ViaFBsize), ramspeed = GET_GLOBAL(ViaRamSpeed);
  65     if (fbsize < 0 || ramspeed < 0) {
  66         set_code_invalid(regs, RET_EUNSUPPORTED);
  67         return;
  68     }
  69     regs->eax = 0x5f;
  70     regs->ebx = 0x500 | (ramspeed << 4) | fbsize;
  71     regs->ecx = 0x060;
  72     set_success(regs);
  73 }
  74
  75 static void
  76 via_155f19(struct bregs *regs)
  77 {
  78     set_invalid_silent(regs);
  79 }
  80
  81 static void
  82 via_155f(struct bregs *regs)
  83 {
  84     switch (regs->al) {
  85     case 0x01: via_155f01(regs); break;
  86     case 0x02: via_155f02(regs); break;
  87     case 0x18: via_155f18(regs); break;
  88     case 0x19: via_155f19(regs); break;
  89     default:   handle_155fXX(regs); break;
  90     }
  91 }
  92
  93 static int
  94 getFBSize(struct pci_device *pci)
  95 {
  96     /* FB config */
  97     u8 reg = pci_config_readb(pci->bdf, 0xa1);
  98
  99     /* GFX disabled ? */
 100     if (!(reg & 0x80))
 101         return -1;
 102
 103     static u8 mem_power[] = {0, 3, 4, 5, 6, 7, 8, 9};
 104     return mem_power[(reg >> 4) & 0x7];
 105 }
 106
 107 static int
 108 getViaRamSpeed(struct pci_device *pci)
 109 {
 110     return (pci_config_readb(pci->bdf, 0x90) & 0x07) + 3;
 111 }
 112
 113 static int
 114 getAMDRamSpeed(void)
 115 {
 116     struct pci_device *pci = pci_find_device(PCI_VENDOR_ID_AMD
 117                                              , PCI_DEVICE_ID_AMD_K8_NB_MEMCTL);
 118     if (!pci)
 119         return -1;
 120
 121     /* mem clk 0 = DDR2 400 */
 122     return (pci_config_readb(pci->bdf, 0x94) & 0x7) + 6;
 123 }
 124
 125 /* int 0x15 - 5f18
 126
 127    ECX = unknown/dont care
 128    EBX[3..0] Frame Buffer Size 2^N MiB
 129    EBX[7..4] Memory speed:
 130        0: SDR  66Mhz
 131        1: SDR 100Mhz
 132        2: SDR 133Mhz
 133        3: DDR 100Mhz (PC1600 or DDR200)
 134        4: DDR 133Mhz (PC2100 or DDR266)
 135        5: DDR 166Mhz (PC2700 or DDR333)
 136        6: DDR 200Mhz (PC3200 or DDR400)
 137        7: DDR2 133Mhz (DDR2 533)
 138        8: DDR2 166Mhz (DDR2 667)
 139        9: DDR2 200Mhz (DDR2 800)
 140        A: DDR2 233Mhz (DDR2 1066)
 141        B: and above: Unknown
 142    EBX[?..8] Total memory size?
 143    EAX = 0x5f for success
 144 */
 145
 146 #define PCI_DEVICE_ID_VIA_K8M890CE_3    0x3336
 147 #define PCI_DEVICE_ID_VIA_VX855_MEMCTRL 0x3409
 148
 149 static void
 150 via_setup(struct pci_device *pci)
 151 {
 152     VGAHookHandlerType = VH_VIA;
 153
 154     struct pci_device *d = pci_find_device(PCI_VENDOR_ID_VIA
 155                                            , PCI_DEVICE_ID_VIA_K8M890CE_3);
 156     if (d) {
 157         ViaFBsize = getFBSize(d);
 158         ViaRamSpeed = getAMDRamSpeed();
 159         return;
 160     }
 161     d = pci_find_device(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_VX855_MEMCTRL);
 162     if (d) {
 163         ViaFBsize = getFBSize(d);
 164         ViaRamSpeed = getViaRamSpeed(d);
 165         return;
 166     }
 167
 168     dprintf(1, "Warning: VGA memory size and speed is hardcoded\n");
 169     ViaFBsize = 5; // 32M frame buffer
 170     ViaRamSpeed = 4; // MCLK = DDR266
 171 }
 172
 173
 174 /****************************************************************
 175  * Intel VGA hooks
 176  ****************************************************************/
 177
 178 u8 IntelDisplayType VARFSEG, IntelDisplayId VARFSEG;
 179
 180 static void
 181 intel_155f35(struct bregs *regs)
 182 {
 183     regs->ax = 0x005f;
 184     regs->cl = GET_GLOBAL(IntelDisplayType);
 185     set_success(regs);
 186 }
 187
 188 static void
 189 intel_155f40(struct bregs *regs)
 190 {
 191     regs->ax = 0x005f;
 192     regs->cl = GET_GLOBAL(IntelDisplayId);
 193     set_success(regs);
 194 }
 195
 196 static void
 197 intel_155f50(struct bregs *regs)
 198 {
 199     /* Mandatory hook on some Dell laptops */
 200     regs->ax = 0x005f;
 201     set_success(regs);
 202 }
 203
 204 static void
 205 intel_155f(struct bregs *regs)
 206 {
 207     switch (regs->al) {
 208     case 0x35: intel_155f35(regs); break;
 209     case 0x40: intel_155f40(regs); break;
 210     case 0x50: intel_155f50(regs); break;
 211     default:   handle_155fXX(regs); break;
 212     }
 213 }
 214
 215 #define BOOT_DISPLAY_DEFAULT    (0)
 216 #define BOOT_DISPLAY_CRT        (1 << 0)
 217 #define BOOT_DISPLAY_TV         (1 << 1)
 218 #define BOOT_DISPLAY_EFP        (1 << 2)
 219 #define BOOT_DISPLAY_LCD        (1 << 3)
 220 #define BOOT_DISPLAY_CRT2       (1 << 4)
 221 #define BOOT_DISPLAY_TV2        (1 << 5)
 222 #define BOOT_DISPLAY_EFP2       (1 << 6)
 223 #define BOOT_DISPLAY_LCD2       (1 << 7)
 224
 225 static void
 226 intel_setup(struct pci_device *pci)
 227 {
 228     VGAHookHandlerType = VH_INTEL;
 229
 230     IntelDisplayType = BOOT_DISPLAY_DEFAULT;
 231     IntelDisplayId = 3;
 232 }
 233
 234 static void
 235 roda_setup(struct pci_device *pci)
 236 {
 237     VGAHookHandlerType = VH_INTEL;
 238     // IntelDisplayType = BOOT_DISPLAY_DEFAULT;
 239     IntelDisplayType = BOOT_DISPLAY_LCD;
 240     // IntelDisplayId = inb(0x60f) & 0x0f; // Correct according to Crete
 241     IntelDisplayId = 3; // Correct according to empirical studies
 242 }
 243
 244 static void
 245 kontron_setup(struct pci_device *pci)
 246 {
 247     VGAHookHandlerType = VH_INTEL;
 248     IntelDisplayType = BOOT_DISPLAY_CRT;
 249     IntelDisplayId = 3;
 250 }
 251
 252 static void
 253 getac_setup(struct pci_device *pci)
 254 {
 255 }
 256
 257 /****************************************************************
 258  * Silicon Motion hooks
 259  ****************************************************************/
 260
 261 u8 SmiBootDisplay VARFSEG; // 1: LCD, 2: CRT, 3: Both */
 262
 263 static void
 264 smi_157f02(struct bregs *regs)
 265 {
 266     /* Boot Display Device Override */
 267     regs->ax = 0x007f;
 268     regs->bl = GET_GLOBAL(SmiBootDisplay);
 269     set_success(regs);
 270 }
 271
 272 static void
 273 smi_157f14(struct bregs *regs)
 274 {
 275     /* ReduceOn support default status */
 276     regs->ax = 0x007f;
 277     regs->bl = 0x00;
 278     set_success(regs);
 279 }
 280
 281 static void
 282 smi_157f(struct bregs *regs)
 283 {
 284     switch (regs->al) {
 285     case 0x02: smi_157f02(regs); break;
 286     case 0x14: smi_157f14(regs); break;
 287     default:   handle_157fXX(regs); break;
 288     }
 289 }
 290
 291 static void
 292 winent_mb6047_setup(struct pci_device *pci)
 293 {
 294     VGAHookHandlerType = VH_SMI;
 295     SmiBootDisplay = 0x02;
 296 }
 297
 298 /****************************************************************
 299  * Entry and setup
 300  ****************************************************************/
 301
 302 // Main 16bit entry point
 303 void
 304 handle_155f(struct bregs *regs)
 305 {
 306     if (!CONFIG_VGAHOOKS) {
 307         handle_155fXX(regs);
 308         return;
 309     }
 310
 311     int htype = GET_GLOBAL(VGAHookHandlerType);
 312     switch (htype) {
 313     case VH_VIA:   via_155f(regs); break;
 314     case VH_INTEL: intel_155f(regs); break;
 315     default:       handle_155fXX(regs); break;
 316     }
 317 }
 318
 319 // Main 16bit entry point
 320 void
 321 handle_157f(struct bregs *regs)
 322 {
 323     if (!CONFIG_VGAHOOKS) {
 324         handle_157fXX(regs);
 325         return;
 326     }
 327
 328     int htype = GET_GLOBAL(VGAHookHandlerType);
 329     switch (htype) {
 330     case VH_SMI:   smi_157f(regs); break;
 331     default:       handle_157fXX(regs); break;
 332     }
 333 }
 334
 335 // Setup
 336 void
 337 vgahook_setup(struct pci_device *pci)
 338 {
 339     if (!CONFIG_VGAHOOKS)
 340         return;
 341
 342     if (strcmp(CBvendor, "KONTRON") == 0 && strcmp(CBpart, "986LCD-M") == 0)
 343         kontron_setup(pci);
 344     else if (strcmp(CBvendor, "GETAC") == 0 && strcmp(CBpart, "P470") == 0)
 345         getac_setup(pci);
 346     else if (strcmp(CBvendor, "RODA") == 0 && strcmp(CBpart, "RK886EX") == 0)
 347         roda_setup(pci);
 348     else if (strcmp(CBvendor, "Win Enterprise") == 0 && strcmp(CBpart, "MB6047") == 0)
 349         winent_mb6047_setup(pci);
 350     else if (pci->vendor == PCI_VENDOR_ID_VIA)
 351         via_setup(pci);
 352     else if (pci->vendor == PCI_VENDOR_ID_INTEL)
 353         intel_setup(pci);
 354 }