[mirror_edk2.git] / OvmfPkg / QemuRamfbDxe / QemuRamfb.c

/** @file\r
  This driver is a implementation of the Graphics Output Protocol\r
  for the QEMU ramfb device.\r
\r
  Copyright (c) 2018, Red Hat Inc.\r
\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include <Protocol/GraphicsOutput.h>\r
\r
#include <Library/BaseLib.h>\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/DevicePathLib.h>\r
#include <Library/FrameBufferBltLib.h>\r
#include <Library/MemoryAllocationLib.h>\r
#include <Library/UefiBootServicesTableLib.h>\r
#include <Library/QemuFwCfgLib.h>\r
\r
#include <Guid/QemuRamfb.h>\r
\r
#define RAMFB_FORMAT  0x34325258 /* DRM_FORMAT_XRGB8888 */\r
#define RAMFB_BPP     4\r
\r
#pragma pack (1)\r
typedef struct RAMFB_CONFIG {\r
  UINT64    Address;\r
  UINT32    FourCC;\r
  UINT32    Flags;\r
  UINT32    Width;\r
  UINT32    Height;\r
  UINT32    Stride;\r
} RAMFB_CONFIG;\r
#pragma pack ()\r
\r
STATIC EFI_HANDLE              mRamfbHandle;\r
STATIC EFI_HANDLE              mGopHandle;\r
STATIC FRAME_BUFFER_CONFIGURE  *mQemuRamfbFrameBufferBltConfigure;\r
STATIC UINTN                   mQemuRamfbFrameBufferBltConfigureSize;\r
STATIC FIRMWARE_CONFIG_ITEM    mRamfbFwCfgItem;\r
\r
STATIC EFI_GRAPHICS_OUTPUT_MODE_INFORMATION  mQemuRamfbModeInfo[] = {\r
  {\r
    0,    // Version\r
    640,  // HorizontalResolution\r
    480,  // VerticalResolution\r
  },{\r
    0,    // Version\r
    800,  // HorizontalResolution\r
    600,  // VerticalResolution\r
  },{\r
    0,    // Version\r
    1024, // HorizontalResolution\r
    768,  // VerticalResolution\r
  }\r
};\r
\r
STATIC EFI_GRAPHICS_OUTPUT_PROTOCOL_MODE  mQemuRamfbMode = {\r
  ARRAY_SIZE (mQemuRamfbModeInfo),                // MaxMode\r
  0,                                              // Mode\r
  mQemuRamfbModeInfo,                             // Info\r
  sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION),  // SizeOfInfo\r
};\r
\r
STATIC\r
EFI_STATUS\r
EFIAPI\r
QemuRamfbGraphicsOutputQueryMode (\r
  IN  EFI_GRAPHICS_OUTPUT_PROTOCOL          *This,\r
  IN  UINT32                                ModeNumber,\r
  OUT UINTN                                 *SizeOfInfo,\r
  OUT EFI_GRAPHICS_OUTPUT_MODE_INFORMATION  **Info\r
  )\r
{\r
  EFI_GRAPHICS_OUTPUT_MODE_INFORMATION  *ModeInfo;\r
\r
  if ((Info == NULL) || (SizeOfInfo == NULL) ||\r
      (ModeNumber >= mQemuRamfbMode.MaxMode))\r
  {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  ModeInfo = &mQemuRamfbModeInfo[ModeNumber];\r
\r
  *Info = AllocateCopyPool (\r
            sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION),\r
            ModeInfo\r
            );\r
  if (*Info == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  *SizeOfInfo = sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION);\r
\r
  return EFI_SUCCESS;\r
}\r
\r
STATIC\r
EFI_STATUS\r
EFIAPI\r
QemuRamfbGraphicsOutputSetMode (\r
  IN  EFI_GRAPHICS_OUTPUT_PROTOCOL  *This,\r
  IN  UINT32                        ModeNumber\r
  )\r
{\r
  EFI_GRAPHICS_OUTPUT_MODE_INFORMATION  *ModeInfo;\r
  RAMFB_CONFIG                          Config;\r
  EFI_GRAPHICS_OUTPUT_BLT_PIXEL         Black;\r
  RETURN_STATUS                         Status;\r
\r
  if (ModeNumber >= mQemuRamfbMode.MaxMode) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  ModeInfo = &mQemuRamfbModeInfo[ModeNumber];\r
\r
  DEBUG ((\r
    DEBUG_INFO,\r
    "Ramfb: SetMode %u (%ux%u)\n",\r
    ModeNumber,\r
    ModeInfo->HorizontalResolution,\r
    ModeInfo->VerticalResolution\r
    ));\r
\r
  Config.Address = SwapBytes64 (mQemuRamfbMode.FrameBufferBase);\r
  Config.FourCC  = SwapBytes32 (RAMFB_FORMAT);\r
  Config.Flags   = SwapBytes32 (0);\r
  Config.Width   = SwapBytes32 (ModeInfo->HorizontalResolution);\r
  Config.Height  = SwapBytes32 (ModeInfo->VerticalResolution);\r
  Config.Stride  = SwapBytes32 (ModeInfo->HorizontalResolution * RAMFB_BPP);\r
\r
  Status = FrameBufferBltConfigure (\r
             (VOID *)(UINTN)mQemuRamfbMode.FrameBufferBase,\r
             ModeInfo,\r
             mQemuRamfbFrameBufferBltConfigure,\r
             &mQemuRamfbFrameBufferBltConfigureSize\r
             );\r
\r
  if (Status == RETURN_BUFFER_TOO_SMALL) {\r
    if (mQemuRamfbFrameBufferBltConfigure != NULL) {\r
      FreePool (mQemuRamfbFrameBufferBltConfigure);\r
    }\r
\r
    mQemuRamfbFrameBufferBltConfigure =\r
      AllocatePool (mQemuRamfbFrameBufferBltConfigureSize);\r
    if (mQemuRamfbFrameBufferBltConfigure == NULL) {\r
      mQemuRamfbFrameBufferBltConfigureSize = 0;\r
      return EFI_OUT_OF_RESOURCES;\r
    }\r
\r
    Status = FrameBufferBltConfigure (\r
               (VOID *)(UINTN)mQemuRamfbMode.FrameBufferBase,\r
               ModeInfo,\r
               mQemuRamfbFrameBufferBltConfigure,\r
               &mQemuRamfbFrameBufferBltConfigureSize\r
               );\r
  }\r
\r
  if (RETURN_ERROR (Status)) {\r
    ASSERT (Status == RETURN_UNSUPPORTED);\r
    return Status;\r
  }\r
\r
  mQemuRamfbMode.Mode = ModeNumber;\r
  mQemuRamfbMode.Info = ModeInfo;\r
\r
  QemuFwCfgSelectItem (mRamfbFwCfgItem);\r
  QemuFwCfgWriteBytes (sizeof (Config), &Config);\r
\r
  //\r
  // clear screen\r
  //\r
  ZeroMem (&Black, sizeof (Black));\r
  Status = FrameBufferBlt (\r
             mQemuRamfbFrameBufferBltConfigure,\r
             &Black,\r
             EfiBltVideoFill,\r
             0,                               // SourceX -- ignored\r
             0,                               // SourceY -- ignored\r
             0,                               // DestinationX\r
             0,                               // DestinationY\r
             ModeInfo->HorizontalResolution,  // Width\r
             ModeInfo->VerticalResolution,    // Height\r
             0                                // Delta -- ignored\r
             );\r
  if (RETURN_ERROR (Status)) {\r
    DEBUG ((\r
      DEBUG_WARN,\r
      "%a: clearing the screen failed: %r\n",\r
      __FUNCTION__,\r
      Status\r
      ));\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
STATIC\r
EFI_STATUS\r
EFIAPI\r
QemuRamfbGraphicsOutputBlt (\r
  IN  EFI_GRAPHICS_OUTPUT_PROTOCOL       *This,\r
  IN  EFI_GRAPHICS_OUTPUT_BLT_PIXEL      *BltBuffer  OPTIONAL,\r
  IN  EFI_GRAPHICS_OUTPUT_BLT_OPERATION  BltOperation,\r
  IN  UINTN                              SourceX,\r
  IN  UINTN                              SourceY,\r
  IN  UINTN                              DestinationX,\r
  IN  UINTN                              DestinationY,\r
  IN  UINTN                              Width,\r
  IN  UINTN                              Height,\r
  IN  UINTN                              Delta\r
  )\r
{\r
  return FrameBufferBlt (\r
           mQemuRamfbFrameBufferBltConfigure,\r
           BltBuffer,\r
           BltOperation,\r
           SourceX,\r
           SourceY,\r
           DestinationX,\r
           DestinationY,\r
           Width,\r
           Height,\r
           Delta\r
           );\r
}\r
\r
STATIC EFI_GRAPHICS_OUTPUT_PROTOCOL  mQemuRamfbGraphicsOutput = {\r
  QemuRamfbGraphicsOutputQueryMode,\r
  QemuRamfbGraphicsOutputSetMode,\r
  QemuRamfbGraphicsOutputBlt,\r
  &mQemuRamfbMode,\r
};\r
\r
EFI_STATUS\r
EFIAPI\r
InitializeQemuRamfb (\r
  IN EFI_HANDLE        ImageHandle,\r
  IN EFI_SYSTEM_TABLE  *SystemTable\r
  )\r
{\r
  EFI_DEVICE_PATH_PROTOCOL  *RamfbDevicePath;\r
  EFI_DEVICE_PATH_PROTOCOL  *GopDevicePath;\r
  VOID                      *DevicePath;\r
  VENDOR_DEVICE_PATH        VendorDeviceNode;\r
  ACPI_ADR_DEVICE_PATH      AcpiDeviceNode;\r
  EFI_STATUS                Status;\r
  EFI_PHYSICAL_ADDRESS      FbBase;\r
  UINTN                     FbSize, MaxFbSize, Pages;\r
  UINTN                     FwCfgSize;\r
  UINTN                     Index;\r
\r
  if (!QemuFwCfgIsAvailable ()) {\r
    DEBUG ((DEBUG_INFO, "Ramfb: no FwCfg\n"));\r
    return EFI_NOT_FOUND;\r
  }\r
\r
  Status = QemuFwCfgFindFile ("etc/ramfb", &mRamfbFwCfgItem, &FwCfgSize);\r
  if (EFI_ERROR (Status)) {\r
    return EFI_NOT_FOUND;\r
  }\r
\r
  if (FwCfgSize != sizeof (RAMFB_CONFIG)) {\r
    DEBUG ((\r
      DEBUG_ERROR,\r
      "Ramfb: FwCfg size mismatch (expected %lu, got %lu)\n",\r
      (UINT64)sizeof (RAMFB_CONFIG),\r
      (UINT64)FwCfgSize\r
      ));\r
    return EFI_PROTOCOL_ERROR;\r
  }\r
\r
  MaxFbSize = 0;\r
  for (Index = 0; Index < ARRAY_SIZE (mQemuRamfbModeInfo); Index++) {\r
    mQemuRamfbModeInfo[Index].PixelsPerScanLine =\r
      mQemuRamfbModeInfo[Index].HorizontalResolution;\r
    mQemuRamfbModeInfo[Index].PixelFormat =\r
      PixelBlueGreenRedReserved8BitPerColor;\r
    FbSize = RAMFB_BPP *\r
             mQemuRamfbModeInfo[Index].HorizontalResolution *\r
             mQemuRamfbModeInfo[Index].VerticalResolution;\r
    if (MaxFbSize < FbSize) {\r
      MaxFbSize = FbSize;\r
    }\r
\r
    DEBUG ((\r
      DEBUG_INFO,\r
      "Ramfb: Mode %lu: %ux%u, %lu kB\n",\r
      (UINT64)Index,\r
      mQemuRamfbModeInfo[Index].HorizontalResolution,\r
      mQemuRamfbModeInfo[Index].VerticalResolution,\r
      (UINT64)(FbSize / 1024)\r
      ));\r
  }\r
\r
  Pages     = EFI_SIZE_TO_PAGES (MaxFbSize);\r
  MaxFbSize = EFI_PAGES_TO_SIZE (Pages);\r
  FbBase    = (EFI_PHYSICAL_ADDRESS)(UINTN)AllocateReservedPages (Pages);\r
  if (FbBase == 0) {\r
    DEBUG ((DEBUG_ERROR, "Ramfb: memory allocation failed\n"));\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  DEBUG ((\r
    DEBUG_INFO,\r
    "Ramfb: Framebuffer at 0x%lx, %lu kB, %lu pages\n",\r
    (UINT64)FbBase,\r
    (UINT64)(MaxFbSize / 1024),\r
    (UINT64)Pages\r
    ));\r
  mQemuRamfbMode.FrameBufferSize = MaxFbSize;\r
  mQemuRamfbMode.FrameBufferBase = FbBase;\r
\r
  //\r
  // 800 x 600\r
  //\r
  QemuRamfbGraphicsOutputSetMode (&mQemuRamfbGraphicsOutput, 1);\r
\r
  //\r
  // ramfb vendor devpath\r
  //\r
  VendorDeviceNode.Header.Type    = HARDWARE_DEVICE_PATH;\r
  VendorDeviceNode.Header.SubType = HW_VENDOR_DP;\r
  CopyGuid (&VendorDeviceNode.Guid, &gQemuRamfbGuid);\r
  SetDevicePathNodeLength (\r
    &VendorDeviceNode.Header,\r
    sizeof (VENDOR_DEVICE_PATH)\r
    );\r
\r
  RamfbDevicePath = AppendDevicePathNode (\r
                      NULL,\r
                      (EFI_DEVICE_PATH_PROTOCOL *)&VendorDeviceNode\r
                      );\r
  if (RamfbDevicePath == NULL) {\r
    Status = EFI_OUT_OF_RESOURCES;\r
    goto FreeFramebuffer;\r
  }\r
\r
  Status = gBS->InstallMultipleProtocolInterfaces (\r
                  &mRamfbHandle,\r
                  &gEfiDevicePathProtocolGuid,\r
                  RamfbDevicePath,\r
                  NULL\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((\r
      DEBUG_ERROR,\r
      "Ramfb: install Ramfb Vendor DevicePath failed: %r\n",\r
      Status\r
      ));\r
    goto FreeRamfbDevicePath;\r
  }\r
\r
  //\r
  // gop devpath + protocol\r
  //\r
  AcpiDeviceNode.Header.Type    = ACPI_DEVICE_PATH;\r
  AcpiDeviceNode.Header.SubType = ACPI_ADR_DP;\r
  AcpiDeviceNode.ADR            = ACPI_DISPLAY_ADR (\r
                                    1,                                      // DeviceIdScheme\r
                                    0,                                      // HeadId\r
                                    0,                                      // NonVgaOutput\r
                                    1,                                      // BiosCanDetect\r
                                    0,                                      // VendorInfo\r
                                    ACPI_ADR_DISPLAY_TYPE_EXTERNAL_DIGITAL, // Type\r
                                    0,                                      // Port\r
                                    0                                       // Index\r
                                    );\r
  SetDevicePathNodeLength (\r
    &AcpiDeviceNode.Header,\r
    sizeof (ACPI_ADR_DEVICE_PATH)\r
    );\r
\r
  GopDevicePath = AppendDevicePathNode (\r
                    RamfbDevicePath,\r
                    (EFI_DEVICE_PATH_PROTOCOL *)&AcpiDeviceNode\r
                    );\r
  if (GopDevicePath == NULL) {\r
    Status = EFI_OUT_OF_RESOURCES;\r
    goto FreeRamfbHandle;\r
  }\r
\r
  Status = gBS->InstallMultipleProtocolInterfaces (\r
                  &mGopHandle,\r
                  &gEfiDevicePathProtocolGuid,\r
                  GopDevicePath,\r
                  &gEfiGraphicsOutputProtocolGuid,\r
                  &mQemuRamfbGraphicsOutput,\r
                  NULL\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((\r
      DEBUG_ERROR,\r
      "Ramfb: install GOP DevicePath failed: %r\n",\r
      Status\r
      ));\r
    goto FreeGopDevicePath;\r
  }\r
\r
  Status = gBS->OpenProtocol (\r
                  mRamfbHandle,\r
                  &gEfiDevicePathProtocolGuid,\r
                  &DevicePath,\r
                  gImageHandle,\r
                  mGopHandle,\r
                  EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((DEBUG_ERROR, "Ramfb: OpenProtocol failed: %r\n", Status));\r
    goto FreeGopHandle;\r
  }\r
\r
  return EFI_SUCCESS;\r
\r
FreeGopHandle:\r
  gBS->UninstallMultipleProtocolInterfaces (\r
         mGopHandle,\r
         &gEfiDevicePathProtocolGuid,\r
         GopDevicePath,\r
         &gEfiGraphicsOutputProtocolGuid,\r
         &mQemuRamfbGraphicsOutput,\r
         NULL\r
         );\r
FreeGopDevicePath:\r
  FreePool (GopDevicePath);\r
FreeRamfbHandle:\r
  gBS->UninstallMultipleProtocolInterfaces (\r
         mRamfbHandle,\r
         &gEfiDevicePathProtocolGuid,\r
         RamfbDevicePath,\r
         NULL\r
         );\r
FreeRamfbDevicePath:\r
  FreePool (RamfbDevicePath);\r
FreeFramebuffer:\r
  FreePages ((VOID *)(UINTN)mQemuRamfbMode.FrameBufferBase, Pages);\r
  return Status;\r
}\r
Commit	Line	Data
1d25ff51 GH	1	/** @file\r
	2	This driver is a implementation of the Graphics Output Protocol\r
	3	for the QEMU ramfb device.\r
	4	\r
	5	Copyright (c) 2018, Red Hat Inc.\r
	6	\r
b26f0cf9	7	SPDX-License-Identifier: BSD-2-Clause-Patent\r
1d25ff51 GH	8	\r
	9	**/\r
	10	\r
	11	#include <Protocol/GraphicsOutput.h>\r
	12	\r
	13	#include <Library/BaseLib.h>\r
	14	#include <Library/BaseMemoryLib.h>\r
	15	#include <Library/DebugLib.h>\r
	16	#include <Library/DevicePathLib.h>\r
	17	#include <Library/FrameBufferBltLib.h>\r
	18	#include <Library/MemoryAllocationLib.h>\r
	19	#include <Library/UefiBootServicesTableLib.h>\r
	20	#include <Library/QemuFwCfgLib.h>\r
	21	\r
	22	#include <Guid/QemuRamfb.h>\r
	23	\r
	24	#define RAMFB_FORMAT 0x34325258 /* DRM_FORMAT_XRGB8888 */\r
	25	#define RAMFB_BPP 4\r
	26	\r
	27	#pragma pack (1)\r
	28	typedef struct RAMFB_CONFIG {\r
ac0a286f MK	29	UINT64 Address;\r
	30	UINT32 FourCC;\r
	31	UINT32 Flags;\r
	32	UINT32 Width;\r
	33	UINT32 Height;\r
	34	UINT32 Stride;\r
1d25ff51 GH	35	} RAMFB_CONFIG;\r
	36	#pragma pack ()\r
	37	\r
ac0a286f MK	38	STATIC EFI_HANDLE mRamfbHandle;\r
	39	STATIC EFI_HANDLE mGopHandle;\r
	40	STATIC FRAME_BUFFER_CONFIGURE *mQemuRamfbFrameBufferBltConfigure;\r
	41	STATIC UINTN mQemuRamfbFrameBufferBltConfigureSize;\r
	42	STATIC FIRMWARE_CONFIG_ITEM mRamfbFwCfgItem;\r
1d25ff51	43	\r
ac0a286f	44	STATIC EFI_GRAPHICS_OUTPUT_MODE_INFORMATION mQemuRamfbModeInfo[] = {\r
1d25ff51 GH	45	{\r
	46	0, // Version\r
	47	640, // HorizontalResolution\r
	48	480, // VerticalResolution\r
	49	},{\r
	50	0, // Version\r
	51	800, // HorizontalResolution\r
	52	600, // VerticalResolution\r
	53	},{\r
	54	0, // Version\r
	55	1024, // HorizontalResolution\r
	56	768, // VerticalResolution\r
	57	}\r
	58	};\r
	59	\r
ac0a286f	60	STATIC EFI_GRAPHICS_OUTPUT_PROTOCOL_MODE mQemuRamfbMode = {\r
1d25ff51 GH	61	ARRAY_SIZE (mQemuRamfbModeInfo), // MaxMode\r
	62	0, // Mode\r
	63	mQemuRamfbModeInfo, // Info\r
	64	sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION), // SizeOfInfo\r
	65	};\r
	66	\r
	67	STATIC\r
	68	EFI_STATUS\r
	69	EFIAPI\r
	70	QemuRamfbGraphicsOutputQueryMode (\r
	71	IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,\r
	72	IN UINT32 ModeNumber,\r
	73	OUT UINTN *SizeOfInfo,\r
	74	OUT EFI_GRAPHICS_OUTPUT_MODE_INFORMATION **Info\r
	75	)\r
	76	{\r
	77	EFI_GRAPHICS_OUTPUT_MODE_INFORMATION *ModeInfo;\r
	78	\r
ac0a286f MK	79	if ((Info == NULL) \|\| (SizeOfInfo == NULL) \|\|\r
	80	(ModeNumber >= mQemuRamfbMode.MaxMode))\r
	81	{\r
1d25ff51 GH	82	return EFI_INVALID_PARAMETER;\r
1d25ff51 GH	83	}\r
ac0a286f	84	\r
1d25ff51 GH	85	ModeInfo = &mQemuRamfbModeInfo[ModeNumber];\r
1d25ff51 GH	86	\r
ac0a286f MK	87	*Info = AllocateCopyPool (\r
	88	sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION),\r
	89	ModeInfo\r
	90	);\r
1d25ff51 GH	91	if (*Info == NULL) {\r
	92	return EFI_OUT_OF_RESOURCES;\r
	93	}\r
ac0a286f	94	\r
1d25ff51 GH	95	*SizeOfInfo = sizeof (EFI_GRAPHICS_OUTPUT_MODE_INFORMATION);\r
	96	\r
	97	return EFI_SUCCESS;\r
	98	}\r
	99	\r
	100	STATIC\r
	101	EFI_STATUS\r
	102	EFIAPI\r
	103	QemuRamfbGraphicsOutputSetMode (\r
ac0a286f MK	104	IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,\r
ac0a286f MK	105	IN UINT32 ModeNumber\r
1d25ff51 GH	106	)\r
	107	{\r
	108	EFI_GRAPHICS_OUTPUT_MODE_INFORMATION *ModeInfo;\r
	109	RAMFB_CONFIG Config;\r
	110	EFI_GRAPHICS_OUTPUT_BLT_PIXEL Black;\r
	111	RETURN_STATUS Status;\r
	112	\r
	113	if (ModeNumber >= mQemuRamfbMode.MaxMode) {\r
	114	return EFI_UNSUPPORTED;\r
	115	}\r
ac0a286f	116	\r
1d25ff51 GH	117	ModeInfo = &mQemuRamfbModeInfo[ModeNumber];\r
1d25ff51 GH	118	\r
ac0a286f MK	119	DEBUG ((\r
	120	DEBUG_INFO,\r
	121	"Ramfb: SetMode %u (%ux%u)\n",\r
	122	ModeNumber,\r
	123	ModeInfo->HorizontalResolution,\r
	124	ModeInfo->VerticalResolution\r
	125	));\r
1d25ff51 GH	126	\r
	127	Config.Address = SwapBytes64 (mQemuRamfbMode.FrameBufferBase);\r
	128	Config.FourCC = SwapBytes32 (RAMFB_FORMAT);\r
	129	Config.Flags = SwapBytes32 (0);\r
	130	Config.Width = SwapBytes32 (ModeInfo->HorizontalResolution);\r
	131	Config.Height = SwapBytes32 (ModeInfo->VerticalResolution);\r
	132	Config.Stride = SwapBytes32 (ModeInfo->HorizontalResolution * RAMFB_BPP);\r
	133	\r
	134	Status = FrameBufferBltConfigure (\r
ac0a286f	135	(VOID *)(UINTN)mQemuRamfbMode.FrameBufferBase,\r
1d25ff51 GH	136	ModeInfo,\r
	137	mQemuRamfbFrameBufferBltConfigure,\r
	138	&mQemuRamfbFrameBufferBltConfigureSize\r
	139	);\r
	140	\r
	141	if (Status == RETURN_BUFFER_TOO_SMALL) {\r
	142	if (mQemuRamfbFrameBufferBltConfigure != NULL) {\r
	143	FreePool (mQemuRamfbFrameBufferBltConfigure);\r
	144	}\r
ac0a286f	145	\r
1d25ff51 GH	146	mQemuRamfbFrameBufferBltConfigure =\r
	147	AllocatePool (mQemuRamfbFrameBufferBltConfigureSize);\r
	148	if (mQemuRamfbFrameBufferBltConfigure == NULL) {\r
	149	mQemuRamfbFrameBufferBltConfigureSize = 0;\r
	150	return EFI_OUT_OF_RESOURCES;\r
	151	}\r
	152	\r
	153	Status = FrameBufferBltConfigure (\r
ac0a286f	154	(VOID *)(UINTN)mQemuRamfbMode.FrameBufferBase,\r
1d25ff51 GH	155	ModeInfo,\r
	156	mQemuRamfbFrameBufferBltConfigure,\r
	157	&mQemuRamfbFrameBufferBltConfigureSize\r
	158	);\r
	159	}\r
ac0a286f	160	\r
1d25ff51 GH	161	if (RETURN_ERROR (Status)) {\r
	162	ASSERT (Status == RETURN_UNSUPPORTED);\r
	163	return Status;\r
	164	}\r
	165	\r
	166	mQemuRamfbMode.Mode = ModeNumber;\r
	167	mQemuRamfbMode.Info = ModeInfo;\r
	168	\r
	169	QemuFwCfgSelectItem (mRamfbFwCfgItem);\r
	170	QemuFwCfgWriteBytes (sizeof (Config), &Config);\r
	171	\r
	172	//\r
	173	// clear screen\r
	174	//\r
	175	ZeroMem (&Black, sizeof (Black));\r
	176	Status = FrameBufferBlt (\r
	177	mQemuRamfbFrameBufferBltConfigure,\r
	178	&Black,\r
	179	EfiBltVideoFill,\r
	180	0, // SourceX -- ignored\r
	181	0, // SourceY -- ignored\r
	182	0, // DestinationX\r
	183	0, // DestinationY\r
	184	ModeInfo->HorizontalResolution, // Width\r
	185	ModeInfo->VerticalResolution, // Height\r
	186	0 // Delta -- ignored\r
	187	);\r
	188	if (RETURN_ERROR (Status)) {\r
ac0a286f MK	189	DEBUG ((\r
	190	DEBUG_WARN,\r
	191	"%a: clearing the screen failed: %r\n",\r
	192	__FUNCTION__,\r
	193	Status\r
	194	));\r
1d25ff51 GH	195	}\r
	196	\r
	197	return EFI_SUCCESS;\r
	198	}\r
	199	\r
	200	STATIC\r
	201	EFI_STATUS\r
	202	EFIAPI\r
	203	QemuRamfbGraphicsOutputBlt (\r
ac0a286f MK	204	IN EFI_GRAPHICS_OUTPUT_PROTOCOL *This,\r
	205	IN EFI_GRAPHICS_OUTPUT_BLT_PIXEL *BltBuffer OPTIONAL,\r
	206	IN EFI_GRAPHICS_OUTPUT_BLT_OPERATION BltOperation,\r
	207	IN UINTN SourceX,\r
	208	IN UINTN SourceY,\r
	209	IN UINTN DestinationX,\r
	210	IN UINTN DestinationY,\r
	211	IN UINTN Width,\r
	212	IN UINTN Height,\r
	213	IN UINTN Delta\r
1d25ff51 GH	214	)\r
	215	{\r
	216	return FrameBufferBlt (\r
	217	mQemuRamfbFrameBufferBltConfigure,\r
	218	BltBuffer,\r
	219	BltOperation,\r
	220	SourceX,\r
	221	SourceY,\r
	222	DestinationX,\r
	223	DestinationY,\r
	224	Width,\r
	225	Height,\r
	226	Delta\r
	227	);\r
	228	}\r
	229	\r
ac0a286f	230	STATIC EFI_GRAPHICS_OUTPUT_PROTOCOL mQemuRamfbGraphicsOutput = {\r
1d25ff51 GH	231	QemuRamfbGraphicsOutputQueryMode,\r
	232	QemuRamfbGraphicsOutputSetMode,\r
	233	QemuRamfbGraphicsOutputBlt,\r
	234	&mQemuRamfbMode,\r
	235	};\r
	236	\r
	237	EFI_STATUS\r
	238	EFIAPI\r
	239	InitializeQemuRamfb (\r
ac0a286f MK	240	IN EFI_HANDLE ImageHandle,\r
ac0a286f MK	241	IN EFI_SYSTEM_TABLE *SystemTable\r
1d25ff51 GH	242	)\r
	243	{\r
	244	EFI_DEVICE_PATH_PROTOCOL *RamfbDevicePath;\r
	245	EFI_DEVICE_PATH_PROTOCOL *GopDevicePath;\r
	246	VOID *DevicePath;\r
	247	VENDOR_DEVICE_PATH VendorDeviceNode;\r
	248	ACPI_ADR_DEVICE_PATH AcpiDeviceNode;\r
	249	EFI_STATUS Status;\r
	250	EFI_PHYSICAL_ADDRESS FbBase;\r
	251	UINTN FbSize, MaxFbSize, Pages;\r
	252	UINTN FwCfgSize;\r
	253	UINTN Index;\r
	254	\r
	255	if (!QemuFwCfgIsAvailable ()) {\r
	256	DEBUG ((DEBUG_INFO, "Ramfb: no FwCfg\n"));\r
	257	return EFI_NOT_FOUND;\r
	258	}\r
	259	\r
	260	Status = QemuFwCfgFindFile ("etc/ramfb", &mRamfbFwCfgItem, &FwCfgSize);\r
	261	if (EFI_ERROR (Status)) {\r
	262	return EFI_NOT_FOUND;\r
	263	}\r
ac0a286f	264	\r
1d25ff51	265	if (FwCfgSize != sizeof (RAMFB_CONFIG)) {\r
ac0a286f MK	266	DEBUG ((\r
	267	DEBUG_ERROR,\r
	268	"Ramfb: FwCfg size mismatch (expected %lu, got %lu)\n",\r
	269	(UINT64)sizeof (RAMFB_CONFIG),\r
	270	(UINT64)FwCfgSize\r
	271	));\r
1d25ff51 GH	272	return EFI_PROTOCOL_ERROR;\r
	273	}\r
	274	\r
	275	MaxFbSize = 0;\r
	276	for (Index = 0; Index < ARRAY_SIZE (mQemuRamfbModeInfo); Index++) {\r
	277	mQemuRamfbModeInfo[Index].PixelsPerScanLine =\r
	278	mQemuRamfbModeInfo[Index].HorizontalResolution;\r
	279	mQemuRamfbModeInfo[Index].PixelFormat =\r
	280	PixelBlueGreenRedReserved8BitPerColor;\r
	281	FbSize = RAMFB_BPP *\r
ac0a286f MK	282	mQemuRamfbModeInfo[Index].HorizontalResolution *\r
ac0a286f MK	283	mQemuRamfbModeInfo[Index].VerticalResolution;\r
1d25ff51 GH	284	if (MaxFbSize < FbSize) {\r
	285	MaxFbSize = FbSize;\r
	286	}\r
ac0a286f MK	287	\r
	288	DEBUG ((\r
	289	DEBUG_INFO,\r
	290	"Ramfb: Mode %lu: %ux%u, %lu kB\n",\r
	291	(UINT64)Index,\r
1d25ff51 GH	292	mQemuRamfbModeInfo[Index].HorizontalResolution,\r
1d25ff51 GH	293	mQemuRamfbModeInfo[Index].VerticalResolution,\r
ac0a286f MK	294	(UINT64)(FbSize / 1024)\r
ac0a286f MK	295	));\r
1d25ff51 GH	296	}\r
1d25ff51 GH	297	\r
ac0a286f	298	Pages = EFI_SIZE_TO_PAGES (MaxFbSize);\r
1d25ff51	299	MaxFbSize = EFI_PAGES_TO_SIZE (Pages);\r
ac0a286f	300	FbBase = (EFI_PHYSICAL_ADDRESS)(UINTN)AllocateReservedPages (Pages);\r
1d25ff51 GH	301	if (FbBase == 0) {\r
	302	DEBUG ((DEBUG_ERROR, "Ramfb: memory allocation failed\n"));\r
	303	return EFI_OUT_OF_RESOURCES;\r
	304	}\r
ac0a286f MK	305	\r
	306	DEBUG ((\r
	307	DEBUG_INFO,\r
	308	"Ramfb: Framebuffer at 0x%lx, %lu kB, %lu pages\n",\r
	309	(UINT64)FbBase,\r
	310	(UINT64)(MaxFbSize / 1024),\r
	311	(UINT64)Pages\r
	312	));\r
1d25ff51 GH	313	mQemuRamfbMode.FrameBufferSize = MaxFbSize;\r
	314	mQemuRamfbMode.FrameBufferBase = FbBase;\r
	315	\r
	316	//\r
	317	// 800 x 600\r
	318	//\r
	319	QemuRamfbGraphicsOutputSetMode (&mQemuRamfbGraphicsOutput, 1);\r
	320	\r
	321	//\r
	322	// ramfb vendor devpath\r
	323	//\r
ac0a286f	324	VendorDeviceNode.Header.Type = HARDWARE_DEVICE_PATH;\r
1d25ff51 GH	325	VendorDeviceNode.Header.SubType = HW_VENDOR_DP;\r
1d25ff51 GH	326	CopyGuid (&VendorDeviceNode.Guid, &gQemuRamfbGuid);\r
ac0a286f MK	327	SetDevicePathNodeLength (\r
	328	&VendorDeviceNode.Header,\r
	329	sizeof (VENDOR_DEVICE_PATH)\r
	330	);\r
1d25ff51	331	\r
ac0a286f MK	332	RamfbDevicePath = AppendDevicePathNode (\r
	333	NULL,\r
	334	(EFI_DEVICE_PATH_PROTOCOL *)&VendorDeviceNode\r
	335	);\r
1d25ff51 GH	336	if (RamfbDevicePath == NULL) {\r
	337	Status = EFI_OUT_OF_RESOURCES;\r
	338	goto FreeFramebuffer;\r
	339	}\r
	340	\r
	341	Status = gBS->InstallMultipleProtocolInterfaces (\r
	342	&mRamfbHandle,\r
	343	&gEfiDevicePathProtocolGuid,\r
	344	RamfbDevicePath,\r
	345	NULL\r
	346	);\r
	347	if (EFI_ERROR (Status)) {\r
ac0a286f MK	348	DEBUG ((\r
	349	DEBUG_ERROR,\r
	350	"Ramfb: install Ramfb Vendor DevicePath failed: %r\n",\r
	351	Status\r
	352	));\r
1d25ff51 GH	353	goto FreeRamfbDevicePath;\r
	354	}\r
	355	\r
	356	//\r
	357	// gop devpath + protocol\r
	358	//\r
ac0a286f	359	AcpiDeviceNode.Header.Type = ACPI_DEVICE_PATH;\r
1d25ff51	360	AcpiDeviceNode.Header.SubType = ACPI_ADR_DP;\r
ac0a286f MK	361	AcpiDeviceNode.ADR = ACPI_DISPLAY_ADR (\r
	362	1, // DeviceIdScheme\r
	363	0, // HeadId\r
	364	0, // NonVgaOutput\r
	365	1, // BiosCanDetect\r
	366	0, // VendorInfo\r
	367	ACPI_ADR_DISPLAY_TYPE_EXTERNAL_DIGITAL, // Type\r
	368	0, // Port\r
	369	0 // Index\r
	370	);\r
	371	SetDevicePathNodeLength (\r
	372	&AcpiDeviceNode.Header,\r
	373	sizeof (ACPI_ADR_DEVICE_PATH)\r
1d25ff51	374	);\r
1d25ff51	375	\r
ac0a286f MK	376	GopDevicePath = AppendDevicePathNode (\r
	377	RamfbDevicePath,\r
	378	(EFI_DEVICE_PATH_PROTOCOL *)&AcpiDeviceNode\r
	379	);\r
1d25ff51 GH	380	if (GopDevicePath == NULL) {\r
	381	Status = EFI_OUT_OF_RESOURCES;\r
	382	goto FreeRamfbHandle;\r
	383	}\r
	384	\r
	385	Status = gBS->InstallMultipleProtocolInterfaces (\r
	386	&mGopHandle,\r
	387	&gEfiDevicePathProtocolGuid,\r
	388	GopDevicePath,\r
	389	&gEfiGraphicsOutputProtocolGuid,\r
	390	&mQemuRamfbGraphicsOutput,\r
	391	NULL\r
	392	);\r
	393	if (EFI_ERROR (Status)) {\r
ac0a286f MK	394	DEBUG ((\r
	395	DEBUG_ERROR,\r
	396	"Ramfb: install GOP DevicePath failed: %r\n",\r
	397	Status\r
	398	));\r
1d25ff51 GH	399	goto FreeGopDevicePath;\r
	400	}\r
	401	\r
	402	Status = gBS->OpenProtocol (\r
	403	mRamfbHandle,\r
	404	&gEfiDevicePathProtocolGuid,\r
	405	&DevicePath,\r
	406	gImageHandle,\r
	407	mGopHandle,\r
	408	EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER\r
	409	);\r
	410	if (EFI_ERROR (Status)) {\r
	411	DEBUG ((DEBUG_ERROR, "Ramfb: OpenProtocol failed: %r\n", Status));\r
	412	goto FreeGopHandle;\r
	413	}\r
	414	\r
	415	return EFI_SUCCESS;\r
	416	\r
	417	FreeGopHandle:\r
	418	gBS->UninstallMultipleProtocolInterfaces (\r
	419	mGopHandle,\r
	420	&gEfiDevicePathProtocolGuid,\r
	421	GopDevicePath,\r
	422	&gEfiGraphicsOutputProtocolGuid,\r
	423	&mQemuRamfbGraphicsOutput,\r
	424	NULL\r
	425	);\r
	426	FreeGopDevicePath:\r
	427	FreePool (GopDevicePath);\r
	428	FreeRamfbHandle:\r
	429	gBS->UninstallMultipleProtocolInterfaces (\r
	430	mRamfbHandle,\r
	431	&gEfiDevicePathProtocolGuid,\r
	432	RamfbDevicePath,\r
	433	NULL\r
	434	);\r
	435	FreeRamfbDevicePath:\r
	436	FreePool (RamfbDevicePath);\r
	437	FreeFramebuffer:\r
ac0a286f	438	FreePages ((VOID *)(UINTN)mQemuRamfbMode.FrameBufferBase, Pages);\r
1d25ff51 GH	439	return Status;\r
1d25ff51 GH	440	}\r