|
@@ -984,6 +984,34 @@ VgaOutb (
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+STATIC
|
|
|
+UINT8
|
|
|
+VgaInb (
|
|
|
+ QEMU_VIDEO_PRIVATE_DATA *Private,
|
|
|
+ UINTN Reg
|
|
|
+ )
|
|
|
+{
|
|
|
+ EFI_STATUS Status;
|
|
|
+ UINT8 Data;
|
|
|
+
|
|
|
+ if (Private->Variant == QEMU_VIDEO_BOCHS_MMIO) {
|
|
|
+ Data = 0;
|
|
|
+ Status = Private->PciIo->Mem.Read (
|
|
|
+ Private->PciIo,
|
|
|
+ EfiPciIoWidthUint8,
|
|
|
+ PCI_BAR_IDX2,
|
|
|
+ 0x400 - 0x3c0 + Reg,
|
|
|
+ 1,
|
|
|
+ &Data
|
|
|
+ );
|
|
|
+ ASSERT_EFI_ERROR (Status);
|
|
|
+ } else {
|
|
|
+ Data = inb (Private, Reg);
|
|
|
+ }
|
|
|
+
|
|
|
+ return Data;
|
|
|
+}
|
|
|
+
|
|
|
VOID
|
|
|
InitializeBochsGraphicsMode (
|
|
|
QEMU_VIDEO_PRIVATE_DATA *Private,
|
|
@@ -998,7 +1026,11 @@ InitializeBochsGraphicsMode (
|
|
|
ModeData->ColorDepth
|
|
|
));
|
|
|
|
|
|
- /* unblank */
|
|
|
+ /* set color mode */
|
|
|
+ VgaOutb (Private, MISC_OUTPUT_REGISTER, 0x01);
|
|
|
+
|
|
|
+ /* reset flip flop + unblank */
|
|
|
+ VgaInb (Private, INPUT_STATUS_1_REGISTER);
|
|
|
VgaOutb (Private, ATT_ADDRESS_REGISTER, 0x20);
|
|
|
|
|
|
BochsWrite (Private, VBE_DISPI_INDEX_ENABLE, 0);
|