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
175 QEMU_VIDEO_PRIVATE_DATA
*Private
;
176 EFI_DEVICE_PATH_PROTOCOL
*ParentDevicePath
;
177 ACPI_ADR_DEVICE_PATH AcpiDeviceNode
;
179 QEMU_VIDEO_CARD
*Card
;
180 EFI_PCI_IO_PROTOCOL
*ChildPciIo
;
182 OldTpl
= gBS
->RaiseTPL (TPL_CALLBACK
);
185 // Allocate Private context data for GOP inteface.
187 Private
= AllocateZeroPool (sizeof (QEMU_VIDEO_PRIVATE_DATA
));
188 if (Private
== NULL
) {
189 Status
= EFI_OUT_OF_RESOURCES
;
194 // Set up context record
196 Private
->Signature
= QEMU_VIDEO_PRIVATE_DATA_SIGNATURE
;
199 // Open PCI I/O Protocol
201 Status
= gBS
->OpenProtocol (
203 &gEfiPciIoProtocolGuid
,
204 (VOID
**) &Private
->PciIo
,
205 This
->DriverBindingHandle
,
207 EFI_OPEN_PROTOCOL_BY_DRIVER
209 if (EFI_ERROR (Status
)) {
214 // Read the PCI Configuration Header from the PCI Device
216 Status
= Private
->PciIo
->Pci
.Read (
220 sizeof (Pci
) / sizeof (UINT32
),
223 if (EFI_ERROR (Status
)) {
228 // Determine card variant.
230 Card
= QemuVideoDetect(Pci
.Hdr
.VendorId
, Pci
.Hdr
.DeviceId
);
232 Status
= EFI_DEVICE_ERROR
;
235 Private
->Variant
= Card
->Variant
;
238 // Save original PCI attributes
240 Status
= Private
->PciIo
->Attributes (
242 EfiPciIoAttributeOperationGet
,
244 &Private
->OriginalPciAttributes
247 if (EFI_ERROR (Status
)) {
252 // Set new PCI attributes
254 Status
= Private
->PciIo
->Attributes (
256 EfiPciIoAttributeOperationEnable
,
257 EFI_PCI_DEVICE_ENABLE
| EFI_PCI_IO_ATTRIBUTE_VGA_MEMORY
| EFI_PCI_IO_ATTRIBUTE_VGA_IO
,
260 if (EFI_ERROR (Status
)) {
265 // Check whenever the qemu stdvga mmio bar is present (qemu 1.3+).
267 if (Private
->Variant
== QEMU_VIDEO_BOCHS_MMIO
) {
268 EFI_ACPI_ADDRESS_SPACE_DESCRIPTOR
*MmioDesc
;
270 Status
= Private
->PciIo
->GetBarAttributes (
276 if (EFI_ERROR (Status
) ||
277 MmioDesc
->ResType
!= ACPI_ADDRESS_SPACE_TYPE_MEM
) {
278 DEBUG ((EFI_D_INFO
, "QemuVideo: No mmio bar, fallback to port io\n"));
279 Private
->Variant
= QEMU_VIDEO_BOCHS
;
281 DEBUG ((EFI_D_INFO
, "QemuVideo: Using mmio bar @ 0x%lx\n",
282 MmioDesc
->AddrRangeMin
));
285 if (!EFI_ERROR (Status
)) {
291 // Check if accessing the bochs interface works.
293 if (Private
->Variant
== QEMU_VIDEO_BOCHS_MMIO
||
294 Private
->Variant
== QEMU_VIDEO_BOCHS
) {
296 BochsId
= BochsRead(Private
, VBE_DISPI_INDEX_ID
);
297 if ((BochsId
& 0xFFF0) != VBE_DISPI_ID0
) {
298 DEBUG ((EFI_D_INFO
, "QemuVideo: BochsID mismatch (got 0x%x)\n", BochsId
));
299 Status
= EFI_DEVICE_ERROR
;
300 goto RestoreAttributes
;
305 // Get ParentDevicePath
307 Status
= gBS
->HandleProtocol (
309 &gEfiDevicePathProtocolGuid
,
310 (VOID
**) &ParentDevicePath
312 if (EFI_ERROR (Status
)) {
313 goto RestoreAttributes
;
317 // Set Gop Device Path
319 ZeroMem (&AcpiDeviceNode
, sizeof (ACPI_ADR_DEVICE_PATH
));
320 AcpiDeviceNode
.Header
.Type
= ACPI_DEVICE_PATH
;
321 AcpiDeviceNode
.Header
.SubType
= ACPI_ADR_DP
;
322 AcpiDeviceNode
.ADR
= ACPI_DISPLAY_ADR (1, 0, 0, 1, 0, ACPI_ADR_DISPLAY_TYPE_VGA
, 0, 0);
323 SetDevicePathNodeLength (&AcpiDeviceNode
.Header
, sizeof (ACPI_ADR_DEVICE_PATH
));
325 Private
->GopDevicePath
= AppendDevicePathNode (
327 (EFI_DEVICE_PATH_PROTOCOL
*) &AcpiDeviceNode
329 if (Private
->GopDevicePath
== NULL
) {
330 Status
= EFI_OUT_OF_RESOURCES
;
331 goto RestoreAttributes
;
335 // Create new child handle and install the device path protocol on it.
337 Status
= gBS
->InstallMultipleProtocolInterfaces (
339 &gEfiDevicePathProtocolGuid
,
340 Private
->GopDevicePath
,
343 if (EFI_ERROR (Status
)) {
344 goto FreeGopDevicePath
;
348 // Construct video mode buffer
350 switch (Private
->Variant
) {
351 case QEMU_VIDEO_CIRRUS_5430
:
352 case QEMU_VIDEO_CIRRUS_5446
:
353 Status
= QemuVideoCirrusModeSetup (Private
);
355 case QEMU_VIDEO_BOCHS_MMIO
:
356 case QEMU_VIDEO_BOCHS
:
357 Status
= QemuVideoBochsModeSetup (Private
);
361 Status
= EFI_DEVICE_ERROR
;
364 if (EFI_ERROR (Status
)) {
365 goto UninstallGopDevicePath
;
369 // Start the GOP software stack.
371 Status
= QemuVideoGraphicsOutputConstructor (Private
);
372 if (EFI_ERROR (Status
)) {
376 Status
= gBS
->InstallMultipleProtocolInterfaces (
378 &gEfiGraphicsOutputProtocolGuid
,
379 &Private
->GraphicsOutput
,
382 if (EFI_ERROR (Status
)) {
383 goto DestructQemuVideoGraphics
;
387 // Reference parent handle from child handle.
389 Status
= gBS
->OpenProtocol (
391 &gEfiPciIoProtocolGuid
,
392 (VOID
**) &ChildPciIo
,
393 This
->DriverBindingHandle
,
395 EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER
397 if (EFI_ERROR (Status
)) {
401 gBS
->RestoreTPL (OldTpl
);
405 gBS
->UninstallProtocolInterface (Private
->Handle
,
406 &gEfiGraphicsOutputProtocolGuid
, &Private
->GraphicsOutput
);
408 DestructQemuVideoGraphics
:
409 QemuVideoGraphicsOutputDestructor (Private
);
412 FreePool (Private
->ModeData
);
414 UninstallGopDevicePath
:
415 gBS
->UninstallProtocolInterface (Private
->Handle
,
416 &gEfiDevicePathProtocolGuid
, Private
->GopDevicePath
);
419 FreePool (Private
->GopDevicePath
);
422 Private
->PciIo
->Attributes (Private
->PciIo
, EfiPciIoAttributeOperationSet
,
423 Private
->OriginalPciAttributes
, NULL
);
426 gBS
->CloseProtocol (Controller
, &gEfiPciIoProtocolGuid
,
427 This
->DriverBindingHandle
, Controller
);
433 gBS
->RestoreTPL (OldTpl
);
441 @param This The USB bus driver binding protocol.
442 @param Controller The controller to release.
443 @param NumberOfChildren The number of children of this device that
444 opened the controller BY_CHILD.
445 @param ChildHandleBuffer The array of child handle.
447 @retval EFI_SUCCESS The controller or children are stopped.
448 @retval EFI_DEVICE_ERROR Failed to stop the driver.
453 QemuVideoControllerDriverStop (
454 IN EFI_DRIVER_BINDING_PROTOCOL
*This
,
455 IN EFI_HANDLE Controller
,
456 IN UINTN NumberOfChildren
,
457 IN EFI_HANDLE
*ChildHandleBuffer
460 EFI_GRAPHICS_OUTPUT_PROTOCOL
*GraphicsOutput
;
463 QEMU_VIDEO_PRIVATE_DATA
*Private
;
465 if (NumberOfChildren
== 0) {
467 // Close the PCI I/O Protocol
471 &gEfiPciIoProtocolGuid
,
472 This
->DriverBindingHandle
,
479 // free all resources for whose access we need the child handle, because the
480 // child handle is going away
482 ASSERT (NumberOfChildren
== 1);
483 Status
= gBS
->OpenProtocol (
484 ChildHandleBuffer
[0],
485 &gEfiGraphicsOutputProtocolGuid
,
486 (VOID
**) &GraphicsOutput
,
487 This
->DriverBindingHandle
,
489 EFI_OPEN_PROTOCOL_GET_PROTOCOL
491 if (EFI_ERROR (Status
)) {
496 // Get our private context information
498 Private
= QEMU_VIDEO_PRIVATE_DATA_FROM_GRAPHICS_OUTPUT_THIS (GraphicsOutput
);
499 ASSERT (Private
->Handle
== ChildHandleBuffer
[0]);
501 QemuVideoGraphicsOutputDestructor (Private
);
503 // Remove the GOP protocol interface from the system
505 Status
= gBS
->UninstallMultipleProtocolInterfaces (
507 &gEfiGraphicsOutputProtocolGuid
,
508 &Private
->GraphicsOutput
,
512 if (EFI_ERROR (Status
)) {
517 // Restore original PCI attributes
519 Private
->PciIo
->Attributes (
521 EfiPciIoAttributeOperationSet
,
522 Private
->OriginalPciAttributes
,
528 &gEfiPciIoProtocolGuid
,
529 This
->DriverBindingHandle
,
533 FreePool (Private
->ModeData
);
534 gBS
->UninstallProtocolInterface (Private
->Handle
,
535 &gEfiDevicePathProtocolGuid
, Private
->GopDevicePath
);
536 FreePool (Private
->GopDevicePath
);
539 // Free our instance data
541 gBS
->FreePool (Private
);
547 TODO: Add function description
549 @param Private TODO: add argument description
550 @param Address TODO: add argument description
551 @param Data TODO: add argument description
553 TODO: add return values
558 QEMU_VIDEO_PRIVATE_DATA
*Private
,
563 Private
->PciIo
->Io
.Write (
566 EFI_PCI_IO_PASS_THROUGH_BAR
,
574 TODO: Add function description
576 @param Private TODO: add argument description
577 @param Address TODO: add argument description
578 @param Data TODO: add argument description
580 TODO: add return values
585 QEMU_VIDEO_PRIVATE_DATA
*Private
,
590 Private
->PciIo
->Io
.Write (
593 EFI_PCI_IO_PASS_THROUGH_BAR
,
601 TODO: Add function description
603 @param Private TODO: add argument description
604 @param Address TODO: add argument description
606 TODO: add return values
611 QEMU_VIDEO_PRIVATE_DATA
*Private
,
617 Private
->PciIo
->Io
.Read (
620 EFI_PCI_IO_PASS_THROUGH_BAR
,
629 TODO: Add function description
631 @param Private TODO: add argument description
632 @param Address TODO: add argument description
634 TODO: add return values
639 QEMU_VIDEO_PRIVATE_DATA
*Private
,
645 Private
->PciIo
->Io
.Read (
648 EFI_PCI_IO_PASS_THROUGH_BAR
,
657 TODO: Add function description
659 @param Private TODO: add argument description
660 @param Index TODO: add argument description
661 @param Red TODO: add argument description
662 @param Green TODO: add argument description
663 @param Blue TODO: add argument description
665 TODO: add return values
670 QEMU_VIDEO_PRIVATE_DATA
*Private
,
677 VgaOutb (Private
, PALETTE_INDEX_REGISTER
, (UINT8
) Index
);
678 VgaOutb (Private
, PALETTE_DATA_REGISTER
, (UINT8
) (Red
>> 2));
679 VgaOutb (Private
, PALETTE_DATA_REGISTER
, (UINT8
) (Green
>> 2));
680 VgaOutb (Private
, PALETTE_DATA_REGISTER
, (UINT8
) (Blue
>> 2));
684 TODO: Add function description
686 @param Private TODO: add argument description
688 TODO: add return values
693 QEMU_VIDEO_PRIVATE_DATA
*Private
702 for (RedIndex
= 0; RedIndex
< 8; RedIndex
++) {
703 for (GreenIndex
= 0; GreenIndex
< 8; GreenIndex
++) {
704 for (BlueIndex
= 0; BlueIndex
< 4; BlueIndex
++) {
705 SetPaletteColor (Private
, Index
, (UINT8
) (RedIndex
<< 5), (UINT8
) (GreenIndex
<< 5), (UINT8
) (BlueIndex
<< 6));
713 TODO: Add function description
715 @param Private TODO: add argument description
717 TODO: add return values
722 QEMU_VIDEO_PRIVATE_DATA
*Private
728 Private
->PciIo
->Mem
.Write (
730 EfiPciIoWidthFillUint32
,
739 TODO: Add function description
741 @param Private TODO: add argument description
743 TODO: add return values
748 QEMU_VIDEO_PRIVATE_DATA
*Private
,
756 TODO: Add function description
758 @param Private TODO: add argument description
759 @param ModeData TODO: add argument description
761 TODO: add return values
765 InitializeCirrusGraphicsMode (
766 QEMU_VIDEO_PRIVATE_DATA
*Private
,
767 QEMU_VIDEO_CIRRUS_MODES
*ModeData
773 outw (Private
, SEQ_ADDRESS_REGISTER
, 0x1206);
774 outw (Private
, SEQ_ADDRESS_REGISTER
, 0x0012);
776 for (Index
= 0; Index
< 15; Index
++) {
777 outw (Private
, SEQ_ADDRESS_REGISTER
, ModeData
->SeqSettings
[Index
]);
780 if (Private
->Variant
== QEMU_VIDEO_CIRRUS_5430
) {
781 outb (Private
, SEQ_ADDRESS_REGISTER
, 0x0f);
782 Byte
= (UINT8
) ((inb (Private
, SEQ_DATA_REGISTER
) & 0xc7) ^ 0x30);
783 outb (Private
, SEQ_DATA_REGISTER
, Byte
);
786 outb (Private
, MISC_OUTPUT_REGISTER
, ModeData
->MiscSetting
);
787 outw (Private
, GRAPH_ADDRESS_REGISTER
, 0x0506);
788 outw (Private
, SEQ_ADDRESS_REGISTER
, 0x0300);
789 outw (Private
, CRTC_ADDRESS_REGISTER
, 0x2011);
791 for (Index
= 0; Index
< 28; Index
++) {
792 outw (Private
, CRTC_ADDRESS_REGISTER
, (UINT16
) ((ModeData
->CrtcSettings
[Index
] << 8) | Index
));
795 for (Index
= 0; Index
< 9; Index
++) {
796 outw (Private
, GRAPH_ADDRESS_REGISTER
, (UINT16
) ((GraphicsController
[Index
] << 8) | Index
));
799 inb (Private
, INPUT_STATUS_1_REGISTER
);
801 for (Index
= 0; Index
< 21; Index
++) {
802 outb (Private
, ATT_ADDRESS_REGISTER
, (UINT8
) Index
);
803 outb (Private
, ATT_ADDRESS_REGISTER
, AttributeController
[Index
]);
806 outb (Private
, ATT_ADDRESS_REGISTER
, 0x20);
808 outw (Private
, GRAPH_ADDRESS_REGISTER
, 0x0009);
809 outw (Private
, GRAPH_ADDRESS_REGISTER
, 0x000a);
810 outw (Private
, GRAPH_ADDRESS_REGISTER
, 0x000b);
811 outb (Private
, DAC_PIXEL_MASK_REGISTER
, 0xff);
813 SetDefaultPalette (Private
);
814 ClearScreen (Private
);
819 QEMU_VIDEO_PRIVATE_DATA
*Private
,
826 if (Private
->Variant
== QEMU_VIDEO_BOCHS_MMIO
) {
827 Status
= Private
->PciIo
->Mem
.Write (
835 ASSERT_EFI_ERROR (Status
);
837 outw (Private
, VBE_DISPI_IOPORT_INDEX
, Reg
);
838 outw (Private
, VBE_DISPI_IOPORT_DATA
, Data
);
844 QEMU_VIDEO_PRIVATE_DATA
*Private
,
851 if (Private
->Variant
== QEMU_VIDEO_BOCHS_MMIO
) {
852 Status
= Private
->PciIo
->Mem
.Read (
860 ASSERT_EFI_ERROR (Status
);
862 outw (Private
, VBE_DISPI_IOPORT_INDEX
, Reg
);
863 Data
= inw (Private
, VBE_DISPI_IOPORT_DATA
);
870 QEMU_VIDEO_PRIVATE_DATA
*Private
,
877 if (Private
->Variant
== QEMU_VIDEO_BOCHS_MMIO
) {
878 Status
= Private
->PciIo
->Mem
.Write (
886 ASSERT_EFI_ERROR (Status
);
888 outb (Private
, Reg
, Data
);
893 InitializeBochsGraphicsMode (
894 QEMU_VIDEO_PRIVATE_DATA
*Private
,
895 QEMU_VIDEO_BOCHS_MODES
*ModeData
898 DEBUG ((EFI_D_INFO
, "InitializeBochsGraphicsMode: %dx%d @ %d\n",
899 ModeData
->Width
, ModeData
->Height
, ModeData
->ColorDepth
));
902 VgaOutb (Private
, ATT_ADDRESS_REGISTER
, 0x20);
904 BochsWrite (Private
, VBE_DISPI_INDEX_ENABLE
, 0);
905 BochsWrite (Private
, VBE_DISPI_INDEX_BANK
, 0);
906 BochsWrite (Private
, VBE_DISPI_INDEX_X_OFFSET
, 0);
907 BochsWrite (Private
, VBE_DISPI_INDEX_Y_OFFSET
, 0);
909 BochsWrite (Private
, VBE_DISPI_INDEX_BPP
, (UINT16
) ModeData
->ColorDepth
);
910 BochsWrite (Private
, VBE_DISPI_INDEX_XRES
, (UINT16
) ModeData
->Width
);
911 BochsWrite (Private
, VBE_DISPI_INDEX_VIRT_WIDTH
, (UINT16
) ModeData
->Width
);
912 BochsWrite (Private
, VBE_DISPI_INDEX_YRES
, (UINT16
) ModeData
->Height
);
913 BochsWrite (Private
, VBE_DISPI_INDEX_VIRT_HEIGHT
, (UINT16
) ModeData
->Height
);
915 BochsWrite (Private
, VBE_DISPI_INDEX_ENABLE
,
916 VBE_DISPI_ENABLED
| VBE_DISPI_LFB_ENABLED
);
918 SetDefaultPalette (Private
);
919 ClearScreen (Private
);
924 InitializeQemuVideo (
925 IN EFI_HANDLE ImageHandle
,
926 IN EFI_SYSTEM_TABLE
*SystemTable
931 Status
= EfiLibInstallDriverBindingComponentName2 (
934 &gQemuVideoDriverBinding
,
936 &gQemuVideoComponentName
,
937 &gQemuVideoComponentName2
939 ASSERT_EFI_ERROR (Status
);
942 // Install EFI Driver Supported EFI Version Protocol required for
943 // EFI drivers that are on PCI and other plug in cards.
945 gQemuVideoDriverSupportedEfiVersion
.FirmwareVersion
= PcdGet32 (PcdDriverSupportedEfiVersion
);
946 Status
= gBS
->InstallMultipleProtocolInterfaces (
948 &gEfiDriverSupportedEfiVersionProtocolGuid
,
949 &gQemuVideoDriverSupportedEfiVersion
,
952 ASSERT_EFI_ERROR (Status
);