2 This driver is a sample implementation of the Graphics Output Protocol for
3 the QEMU (Cirrus Logic 5446) video controller.
5 Copyright (c) 2006 - 2010, Intel Corporation. All rights reserved.<BR>
7 This program and the accompanying materials
8 are licensed and made available under the terms and conditions of the BSD License
9 which accompanies this distribution. The full text of the license may be found at
10 http://opensource.org/licenses/bsd-license.php
12 THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
13 WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
18 #include <IndustryStandard/Acpi.h>
20 EFI_DRIVER_BINDING_PROTOCOL gQemuVideoDriverBinding
= {
21 QemuVideoControllerDriverSupported
,
22 QemuVideoControllerDriverStart
,
23 QemuVideoControllerDriverStop
,
29 QEMU_VIDEO_CARD gQemuVideoCardList
[] = {
31 CIRRUS_LOGIC_VENDOR_ID
,
32 CIRRUS_LOGIC_5430_DEVICE_ID
,
33 QEMU_VIDEO_CIRRUS_5430
,
36 CIRRUS_LOGIC_VENDOR_ID
,
37 CIRRUS_LOGIC_5430_ALTERNATE_DEVICE_ID
,
38 QEMU_VIDEO_CIRRUS_5430
,
41 CIRRUS_LOGIC_VENDOR_ID
,
42 CIRRUS_LOGIC_5446_DEVICE_ID
,
43 QEMU_VIDEO_CIRRUS_5446
,
48 QEMU_VIDEO_BOCHS_MMIO
,
60 static QEMU_VIDEO_CARD
*
68 while (gQemuVideoCardList
[Index
].VendorId
!= 0) {
69 if (gQemuVideoCardList
[Index
].VendorId
== VendorId
&&
70 gQemuVideoCardList
[Index
].DeviceId
== DeviceId
) {
71 return gQemuVideoCardList
+ Index
;
79 Check if this device is supported.
81 @param This The driver binding protocol.
82 @param Controller The controller handle to check.
83 @param RemainingDevicePath The remaining device path.
85 @retval EFI_SUCCESS The bus supports this controller.
86 @retval EFI_UNSUPPORTED This device isn't supported.
91 QemuVideoControllerDriverSupported (
92 IN EFI_DRIVER_BINDING_PROTOCOL
*This
,
93 IN EFI_HANDLE Controller
,
94 IN EFI_DEVICE_PATH_PROTOCOL
*RemainingDevicePath
98 EFI_PCI_IO_PROTOCOL
*PciIo
;
100 QEMU_VIDEO_CARD
*Card
;
103 // Open the PCI I/O Protocol
105 Status
= gBS
->OpenProtocol (
107 &gEfiPciIoProtocolGuid
,
109 This
->DriverBindingHandle
,
111 EFI_OPEN_PROTOCOL_BY_DRIVER
113 if (EFI_ERROR (Status
)) {
118 // Read the PCI Configuration Header from the PCI Device
120 Status
= PciIo
->Pci
.Read (
124 sizeof (Pci
) / sizeof (UINT32
),
127 if (EFI_ERROR (Status
)) {
131 Status
= EFI_UNSUPPORTED
;
132 Card
= QemuVideoDetect(Pci
.Hdr
.VendorId
, Pci
.Hdr
.DeviceId
);
134 DEBUG ((EFI_D_INFO
, "QemuVideo: %s detected\n", Card
->Name
));
135 Status
= EFI_SUCCESS
;
140 // Close the PCI I/O Protocol
144 &gEfiPciIoProtocolGuid
,
145 This
->DriverBindingHandle
,
153 Start to process the controller.
155 @param This The USB bus driver binding instance.
156 @param Controller The controller to check.
157 @param RemainingDevicePath The remaining device patch.
159 @retval EFI_SUCCESS The controller is controlled by the usb bus.
160 @retval EFI_ALREADY_STARTED The controller is already controlled by the usb
162 @retval EFI_OUT_OF_RESOURCES Failed to allocate resources.
167 QemuVideoControllerDriverStart (
168 IN EFI_DRIVER_BINDING_PROTOCOL
*This
,
169 IN EFI_HANDLE Controller
,
170 IN EFI_DEVICE_PATH_PROTOCOL
*RemainingDevicePath
174 QEMU_VIDEO_PRIVATE_DATA
*Private
;
175 EFI_DEVICE_PATH_PROTOCOL
*ParentDevicePath
;
176 ACPI_ADR_DEVICE_PATH AcpiDeviceNode
;
178 QEMU_VIDEO_CARD
*Card
;
179 EFI_PCI_IO_PROTOCOL
*ChildPciIo
;
182 // Allocate Private context data for GOP inteface.
184 Private
= AllocateZeroPool (sizeof (QEMU_VIDEO_PRIVATE_DATA
));
185 if (Private
== NULL
) {
186 return EFI_OUT_OF_RESOURCES
;
190 // Set up context record
192 Private
->Signature
= QEMU_VIDEO_PRIVATE_DATA_SIGNATURE
;
195 // Open PCI I/O Protocol
197 Status
= gBS
->OpenProtocol (
199 &gEfiPciIoProtocolGuid
,
200 (VOID
**) &Private
->PciIo
,
201 This
->DriverBindingHandle
,
203 EFI_OPEN_PROTOCOL_BY_DRIVER
205 if (EFI_ERROR (Status
)) {
210 // Read the PCI Configuration Header from the PCI Device
212 Status
= Private
->PciIo
->Pci
.Read (
216 sizeof (Pci
) / sizeof (UINT32
),
219 if (EFI_ERROR (Status
)) {
224 // Determine card variant.
226 Card
= QemuVideoDetect(Pci
.Hdr
.VendorId
, Pci
.Hdr
.DeviceId
);
228 Status
= EFI_DEVICE_ERROR
;
231 Private
->Variant
= Card
->Variant
;
234 // Save original PCI attributes
236 Status
= Private
->PciIo
->Attributes (
238 EfiPciIoAttributeOperationGet
,
240 &Private
->OriginalPciAttributes
243 if (EFI_ERROR (Status
)) {
248 // Set new PCI attributes
250 Status
= Private
->PciIo
->Attributes (
252 EfiPciIoAttributeOperationEnable
,
253 EFI_PCI_DEVICE_ENABLE
| EFI_PCI_IO_ATTRIBUTE_VGA_MEMORY
| EFI_PCI_IO_ATTRIBUTE_VGA_IO
,
256 if (EFI_ERROR (Status
)) {
261 // Check whenever the qemu stdvga mmio bar is present (qemu 1.3+).
263 if (Private
->Variant
== QEMU_VIDEO_BOCHS_MMIO
) {
264 EFI_ACPI_ADDRESS_SPACE_DESCRIPTOR
*MmioDesc
;
266 Status
= Private
->PciIo
->GetBarAttributes (
272 if (EFI_ERROR (Status
) ||
273 MmioDesc
->ResType
!= ACPI_ADDRESS_SPACE_TYPE_MEM
) {
274 DEBUG ((EFI_D_INFO
, "QemuVideo: No mmio bar, fallback to port io\n"));
275 Private
->Variant
= QEMU_VIDEO_BOCHS
;
277 DEBUG ((EFI_D_INFO
, "QemuVideo: Using mmio bar @ 0x%lx\n",
278 MmioDesc
->AddrRangeMin
));
281 if (!EFI_ERROR (Status
)) {
287 // Check if accessing the bochs interface works.
289 if (Private
->Variant
== QEMU_VIDEO_BOCHS_MMIO
||
290 Private
->Variant
== QEMU_VIDEO_BOCHS
) {
292 BochsId
= BochsRead(Private
, VBE_DISPI_INDEX_ID
);
293 if ((BochsId
& 0xFFF0) != VBE_DISPI_ID0
) {
294 DEBUG ((EFI_D_INFO
, "QemuVideo: BochsID mismatch (got 0x%x)\n", BochsId
));
295 Status
= EFI_DEVICE_ERROR
;
296 goto RestoreAttributes
;
301 // Get ParentDevicePath
303 Status
= gBS
->HandleProtocol (
305 &gEfiDevicePathProtocolGuid
,
306 (VOID
**) &ParentDevicePath
308 if (EFI_ERROR (Status
)) {
309 goto RestoreAttributes
;
313 // Set Gop Device Path
315 ZeroMem (&AcpiDeviceNode
, sizeof (ACPI_ADR_DEVICE_PATH
));
316 AcpiDeviceNode
.Header
.Type
= ACPI_DEVICE_PATH
;
317 AcpiDeviceNode
.Header
.SubType
= ACPI_ADR_DP
;
318 AcpiDeviceNode
.ADR
= ACPI_DISPLAY_ADR (1, 0, 0, 1, 0, ACPI_ADR_DISPLAY_TYPE_VGA
, 0, 0);
319 SetDevicePathNodeLength (&AcpiDeviceNode
.Header
, sizeof (ACPI_ADR_DEVICE_PATH
));
321 Private
->GopDevicePath
= AppendDevicePathNode (
323 (EFI_DEVICE_PATH_PROTOCOL
*) &AcpiDeviceNode
325 if (Private
->GopDevicePath
== NULL
) {
326 Status
= EFI_OUT_OF_RESOURCES
;
327 goto RestoreAttributes
;
331 // Create new child handle and install the device path protocol on it.
333 Status
= gBS
->InstallMultipleProtocolInterfaces (
335 &gEfiDevicePathProtocolGuid
,
336 Private
->GopDevicePath
,
339 if (EFI_ERROR (Status
)) {
340 goto FreeGopDevicePath
;
344 // Construct video mode buffer
346 switch (Private
->Variant
) {
347 case QEMU_VIDEO_CIRRUS_5430
:
348 case QEMU_VIDEO_CIRRUS_5446
:
349 Status
= QemuVideoCirrusModeSetup (Private
);
351 case QEMU_VIDEO_BOCHS_MMIO
:
352 case QEMU_VIDEO_BOCHS
:
353 Status
= QemuVideoBochsModeSetup (Private
);
357 Status
= EFI_DEVICE_ERROR
;
360 if (EFI_ERROR (Status
)) {
361 goto UninstallGopDevicePath
;
365 // Start the GOP software stack.
367 Status
= QemuVideoGraphicsOutputConstructor (Private
);
368 if (EFI_ERROR (Status
)) {
372 Status
= gBS
->InstallMultipleProtocolInterfaces (
374 &gEfiGraphicsOutputProtocolGuid
,
375 &Private
->GraphicsOutput
,
378 if (EFI_ERROR (Status
)) {
379 goto DestructQemuVideoGraphics
;
383 // Reference parent handle from child handle.
385 Status
= gBS
->OpenProtocol (
387 &gEfiPciIoProtocolGuid
,
388 (VOID
**) &ChildPciIo
,
389 This
->DriverBindingHandle
,
391 EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER
393 if (EFI_ERROR (Status
)) {
400 gBS
->UninstallProtocolInterface (Private
->Handle
,
401 &gEfiGraphicsOutputProtocolGuid
, &Private
->GraphicsOutput
);
403 DestructQemuVideoGraphics
:
404 QemuVideoGraphicsOutputDestructor (Private
);
407 FreePool (Private
->ModeData
);
409 UninstallGopDevicePath
:
410 gBS
->UninstallProtocolInterface (Private
->Handle
,
411 &gEfiDevicePathProtocolGuid
, Private
->GopDevicePath
);
414 FreePool (Private
->GopDevicePath
);
417 Private
->PciIo
->Attributes (Private
->PciIo
, EfiPciIoAttributeOperationSet
,
418 Private
->OriginalPciAttributes
, NULL
);
421 gBS
->CloseProtocol (Controller
, &gEfiPciIoProtocolGuid
,
422 This
->DriverBindingHandle
, Controller
);
433 @param This The USB bus driver binding protocol.
434 @param Controller The controller to release.
435 @param NumberOfChildren The number of children of this device that
436 opened the controller BY_CHILD.
437 @param ChildHandleBuffer The array of child handle.
439 @retval EFI_SUCCESS The controller or children are stopped.
440 @retval EFI_DEVICE_ERROR Failed to stop the driver.
445 QemuVideoControllerDriverStop (
446 IN EFI_DRIVER_BINDING_PROTOCOL
*This
,
447 IN EFI_HANDLE Controller
,
448 IN UINTN NumberOfChildren
,
449 IN EFI_HANDLE
*ChildHandleBuffer
452 EFI_GRAPHICS_OUTPUT_PROTOCOL
*GraphicsOutput
;
455 QEMU_VIDEO_PRIVATE_DATA
*Private
;
457 if (NumberOfChildren
== 0) {
459 // Close the PCI I/O Protocol
463 &gEfiPciIoProtocolGuid
,
464 This
->DriverBindingHandle
,
471 // free all resources for whose access we need the child handle, because the
472 // child handle is going away
474 ASSERT (NumberOfChildren
== 1);
475 Status
= gBS
->OpenProtocol (
476 ChildHandleBuffer
[0],
477 &gEfiGraphicsOutputProtocolGuid
,
478 (VOID
**) &GraphicsOutput
,
479 This
->DriverBindingHandle
,
481 EFI_OPEN_PROTOCOL_GET_PROTOCOL
483 if (EFI_ERROR (Status
)) {
488 // Get our private context information
490 Private
= QEMU_VIDEO_PRIVATE_DATA_FROM_GRAPHICS_OUTPUT_THIS (GraphicsOutput
);
491 ASSERT (Private
->Handle
== ChildHandleBuffer
[0]);
493 QemuVideoGraphicsOutputDestructor (Private
);
495 // Remove the GOP protocol interface from the system
497 Status
= gBS
->UninstallMultipleProtocolInterfaces (
499 &gEfiGraphicsOutputProtocolGuid
,
500 &Private
->GraphicsOutput
,
504 if (EFI_ERROR (Status
)) {
509 // Restore original PCI attributes
511 Private
->PciIo
->Attributes (
513 EfiPciIoAttributeOperationSet
,
514 Private
->OriginalPciAttributes
,
520 &gEfiPciIoProtocolGuid
,
521 This
->DriverBindingHandle
,
526 // Free our instance data
528 gBS
->FreePool (Private
);
534 TODO: Add function description
536 @param Private TODO: add argument description
537 @param Address TODO: add argument description
538 @param Data TODO: add argument description
540 TODO: add return values
545 QEMU_VIDEO_PRIVATE_DATA
*Private
,
550 Private
->PciIo
->Io
.Write (
553 EFI_PCI_IO_PASS_THROUGH_BAR
,
561 TODO: Add function description
563 @param Private TODO: add argument description
564 @param Address TODO: add argument description
565 @param Data TODO: add argument description
567 TODO: add return values
572 QEMU_VIDEO_PRIVATE_DATA
*Private
,
577 Private
->PciIo
->Io
.Write (
580 EFI_PCI_IO_PASS_THROUGH_BAR
,
588 TODO: Add function description
590 @param Private TODO: add argument description
591 @param Address TODO: add argument description
593 TODO: add return values
598 QEMU_VIDEO_PRIVATE_DATA
*Private
,
604 Private
->PciIo
->Io
.Read (
607 EFI_PCI_IO_PASS_THROUGH_BAR
,
616 TODO: Add function description
618 @param Private TODO: add argument description
619 @param Address TODO: add argument description
621 TODO: add return values
626 QEMU_VIDEO_PRIVATE_DATA
*Private
,
632 Private
->PciIo
->Io
.Read (
635 EFI_PCI_IO_PASS_THROUGH_BAR
,
644 TODO: Add function description
646 @param Private TODO: add argument description
647 @param Index TODO: add argument description
648 @param Red TODO: add argument description
649 @param Green TODO: add argument description
650 @param Blue TODO: add argument description
652 TODO: add return values
657 QEMU_VIDEO_PRIVATE_DATA
*Private
,
664 VgaOutb (Private
, PALETTE_INDEX_REGISTER
, (UINT8
) Index
);
665 VgaOutb (Private
, PALETTE_DATA_REGISTER
, (UINT8
) (Red
>> 2));
666 VgaOutb (Private
, PALETTE_DATA_REGISTER
, (UINT8
) (Green
>> 2));
667 VgaOutb (Private
, PALETTE_DATA_REGISTER
, (UINT8
) (Blue
>> 2));
671 TODO: Add function description
673 @param Private TODO: add argument description
675 TODO: add return values
680 QEMU_VIDEO_PRIVATE_DATA
*Private
689 for (RedIndex
= 0; RedIndex
< 8; RedIndex
++) {
690 for (GreenIndex
= 0; GreenIndex
< 8; GreenIndex
++) {
691 for (BlueIndex
= 0; BlueIndex
< 4; BlueIndex
++) {
692 SetPaletteColor (Private
, Index
, (UINT8
) (RedIndex
<< 5), (UINT8
) (GreenIndex
<< 5), (UINT8
) (BlueIndex
<< 6));
700 TODO: Add function description
702 @param Private TODO: add argument description
704 TODO: add return values
709 QEMU_VIDEO_PRIVATE_DATA
*Private
715 Private
->PciIo
->Mem
.Write (
717 EfiPciIoWidthFillUint32
,
726 TODO: Add function description
728 @param Private TODO: add argument description
730 TODO: add return values
735 QEMU_VIDEO_PRIVATE_DATA
*Private
,
743 TODO: Add function description
745 @param Private TODO: add argument description
746 @param ModeData TODO: add argument description
748 TODO: add return values
752 InitializeCirrusGraphicsMode (
753 QEMU_VIDEO_PRIVATE_DATA
*Private
,
754 QEMU_VIDEO_CIRRUS_MODES
*ModeData
760 outw (Private
, SEQ_ADDRESS_REGISTER
, 0x1206);
761 outw (Private
, SEQ_ADDRESS_REGISTER
, 0x0012);
763 for (Index
= 0; Index
< 15; Index
++) {
764 outw (Private
, SEQ_ADDRESS_REGISTER
, ModeData
->SeqSettings
[Index
]);
767 if (Private
->Variant
== QEMU_VIDEO_CIRRUS_5430
) {
768 outb (Private
, SEQ_ADDRESS_REGISTER
, 0x0f);
769 Byte
= (UINT8
) ((inb (Private
, SEQ_DATA_REGISTER
) & 0xc7) ^ 0x30);
770 outb (Private
, SEQ_DATA_REGISTER
, Byte
);
773 outb (Private
, MISC_OUTPUT_REGISTER
, ModeData
->MiscSetting
);
774 outw (Private
, GRAPH_ADDRESS_REGISTER
, 0x0506);
775 outw (Private
, SEQ_ADDRESS_REGISTER
, 0x0300);
776 outw (Private
, CRTC_ADDRESS_REGISTER
, 0x2011);
778 for (Index
= 0; Index
< 28; Index
++) {
779 outw (Private
, CRTC_ADDRESS_REGISTER
, (UINT16
) ((ModeData
->CrtcSettings
[Index
] << 8) | Index
));
782 for (Index
= 0; Index
< 9; Index
++) {
783 outw (Private
, GRAPH_ADDRESS_REGISTER
, (UINT16
) ((GraphicsController
[Index
] << 8) | Index
));
786 inb (Private
, INPUT_STATUS_1_REGISTER
);
788 for (Index
= 0; Index
< 21; Index
++) {
789 outb (Private
, ATT_ADDRESS_REGISTER
, (UINT8
) Index
);
790 outb (Private
, ATT_ADDRESS_REGISTER
, AttributeController
[Index
]);
793 outb (Private
, ATT_ADDRESS_REGISTER
, 0x20);
795 outw (Private
, GRAPH_ADDRESS_REGISTER
, 0x0009);
796 outw (Private
, GRAPH_ADDRESS_REGISTER
, 0x000a);
797 outw (Private
, GRAPH_ADDRESS_REGISTER
, 0x000b);
798 outb (Private
, DAC_PIXEL_MASK_REGISTER
, 0xff);
800 SetDefaultPalette (Private
);
801 ClearScreen (Private
);
806 QEMU_VIDEO_PRIVATE_DATA
*Private
,
813 if (Private
->Variant
== QEMU_VIDEO_BOCHS_MMIO
) {
814 Status
= Private
->PciIo
->Mem
.Write (
822 ASSERT_EFI_ERROR (Status
);
824 outw (Private
, VBE_DISPI_IOPORT_INDEX
, Reg
);
825 outw (Private
, VBE_DISPI_IOPORT_DATA
, Data
);
831 QEMU_VIDEO_PRIVATE_DATA
*Private
,
838 if (Private
->Variant
== QEMU_VIDEO_BOCHS_MMIO
) {
839 Status
= Private
->PciIo
->Mem
.Read (
847 ASSERT_EFI_ERROR (Status
);
849 outw (Private
, VBE_DISPI_IOPORT_INDEX
, Reg
);
850 Data
= inw (Private
, VBE_DISPI_IOPORT_DATA
);
857 QEMU_VIDEO_PRIVATE_DATA
*Private
,
864 if (Private
->Variant
== QEMU_VIDEO_BOCHS_MMIO
) {
865 Status
= Private
->PciIo
->Mem
.Write (
873 ASSERT_EFI_ERROR (Status
);
875 outb (Private
, Reg
, Data
);
880 InitializeBochsGraphicsMode (
881 QEMU_VIDEO_PRIVATE_DATA
*Private
,
882 QEMU_VIDEO_BOCHS_MODES
*ModeData
885 DEBUG ((EFI_D_INFO
, "InitializeBochsGraphicsMode: %dx%d @ %d\n",
886 ModeData
->Width
, ModeData
->Height
, ModeData
->ColorDepth
));
889 VgaOutb (Private
, ATT_ADDRESS_REGISTER
, 0x20);
891 BochsWrite (Private
, VBE_DISPI_INDEX_ENABLE
, 0);
892 BochsWrite (Private
, VBE_DISPI_INDEX_BANK
, 0);
893 BochsWrite (Private
, VBE_DISPI_INDEX_X_OFFSET
, 0);
894 BochsWrite (Private
, VBE_DISPI_INDEX_Y_OFFSET
, 0);
896 BochsWrite (Private
, VBE_DISPI_INDEX_BPP
, (UINT16
) ModeData
->ColorDepth
);
897 BochsWrite (Private
, VBE_DISPI_INDEX_XRES
, (UINT16
) ModeData
->Width
);
898 BochsWrite (Private
, VBE_DISPI_INDEX_VIRT_WIDTH
, (UINT16
) ModeData
->Width
);
899 BochsWrite (Private
, VBE_DISPI_INDEX_YRES
, (UINT16
) ModeData
->Height
);
900 BochsWrite (Private
, VBE_DISPI_INDEX_VIRT_HEIGHT
, (UINT16
) ModeData
->Height
);
902 BochsWrite (Private
, VBE_DISPI_INDEX_ENABLE
,
903 VBE_DISPI_ENABLED
| VBE_DISPI_LFB_ENABLED
);
905 SetDefaultPalette (Private
);
906 ClearScreen (Private
);
911 InitializeQemuVideo (
912 IN EFI_HANDLE ImageHandle
,
913 IN EFI_SYSTEM_TABLE
*SystemTable
918 Status
= EfiLibInstallDriverBindingComponentName2 (
921 &gQemuVideoDriverBinding
,
923 &gQemuVideoComponentName
,
924 &gQemuVideoComponentName2
926 ASSERT_EFI_ERROR (Status
);
929 // Install EFI Driver Supported EFI Version Protocol required for
930 // EFI drivers that are on PCI and other plug in cards.
932 gQemuVideoDriverSupportedEfiVersion
.FirmwareVersion
= PcdGet32 (PcdDriverSupportedEfiVersion
);
933 Status
= gBS
->InstallMultipleProtocolInterfaces (
935 &gEfiDriverSupportedEfiVersionProtocolGuid
,
936 &gQemuVideoDriverSupportedEfiVersion
,
939 ASSERT_EFI_ERROR (Status
);