OvmfPkg/QemuVideoDxe/VbeShim: handle PAM1 register on Q35 correctly

[mirror_edk2.git] / OvmfPkg / QemuFlashFvbServicesRuntimeDxe / FwBlockServiceDxe.c

/**@file\r
  Functions related to the Firmware Volume Block service whose\r
  implementation is specific to the runtime DXE driver build.\r
\r
  Copyright (C) 2015, Red Hat, Inc.\r
  Copyright (c) 2006 - 2014, Intel Corporation. All rights reserved.<BR>\r
\r
  This program and the accompanying materials are licensed and made available\r
  under the terms and conditions of the BSD License which accompanies this\r
  distribution.  The full text of the license may be found at\r
  http://opensource.org/licenses/bsd-license.php\r
\r
  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
**/\r
\r
#include <Guid/EventGroup.h>\r
#include <Library/DebugLib.h>\r
#include <Library/DevicePathLib.h>\r
#include <Library/PcdLib.h>\r
#include <Library/UefiBootServicesTableLib.h>\r
#include <Library/UefiRuntimeLib.h>\r
#include <Protocol/DevicePath.h>\r
#include <Protocol/FirmwareVolumeBlock.h>\r
\r
#include "FwBlockService.h"\r
#include "QemuFlash.h"\r
\r
VOID\r
InstallProtocolInterfaces (\r
  IN EFI_FW_VOL_BLOCK_DEVICE *FvbDevice\r
  )\r
{\r
  EFI_STATUS                         Status;\r
  EFI_HANDLE                         FwbHandle;\r
  EFI_FIRMWARE_VOLUME_BLOCK_PROTOCOL *OldFwbInterface;\r
\r
  ASSERT (!FeaturePcdGet (PcdSmmSmramRequire));\r
\r
  //\r
  // Find a handle with a matching device path that has supports FW Block\r
  // protocol\r
  //\r
  Status = gBS->LocateDevicePath (&gEfiFirmwareVolumeBlockProtocolGuid,\r
                  &FvbDevice->DevicePath, &FwbHandle);\r
  if (EFI_ERROR (Status)) {\r
    //\r
    // LocateDevicePath fails so install a new interface and device path\r
    //\r
    FwbHandle = NULL;\r
    DEBUG ((EFI_D_INFO, "Installing QEMU flash FVB\n"));\r
    Status = gBS->InstallMultipleProtocolInterfaces (\r
                    &FwbHandle,\r
                    &gEfiFirmwareVolumeBlockProtocolGuid,\r
                    &FvbDevice->FwVolBlockInstance,\r
                    &gEfiDevicePathProtocolGuid,\r
                    FvbDevice->DevicePath,\r
                    NULL\r
                    );\r
    ASSERT_EFI_ERROR (Status);\r
  } else if (IsDevicePathEnd (FvbDevice->DevicePath)) {\r
    //\r
    // Device already exists, so reinstall the FVB protocol\r
    //\r
    Status = gBS->HandleProtocol (\r
                    FwbHandle,\r
                    &gEfiFirmwareVolumeBlockProtocolGuid,\r
                    (VOID**)&OldFwbInterface\r
                    );\r
    ASSERT_EFI_ERROR (Status);\r
\r
    DEBUG ((EFI_D_INFO, "Reinstalling FVB for QEMU flash region\n"));\r
    Status = gBS->ReinstallProtocolInterface (\r
                    FwbHandle,\r
                    &gEfiFirmwareVolumeBlockProtocolGuid,\r
                    OldFwbInterface,\r
                    &FvbDevice->FwVolBlockInstance\r
                    );\r
    ASSERT_EFI_ERROR (Status);\r
  } else {\r
    //\r
    // There was a FVB protocol on an End Device Path node\r
    //\r
    ASSERT (FALSE);\r
  }\r
}\r
\r
\r
STATIC\r
VOID\r
EFIAPI\r
FvbVirtualAddressChangeEvent (\r
  IN EFI_EVENT        Event,\r
  IN VOID             *Context\r
  )\r
/*++\r
\r
  Routine Description:\r
\r
    Fixup internal data so that EFI and SAL can be call in virtual mode.\r
    Call the passed in Child Notify event and convert the mFvbModuleGlobal\r
    date items to there virtual address.\r
\r
  Arguments:\r
\r
    (Standard EFI notify event - EFI_EVENT_NOTIFY)\r
\r
  Returns:\r
\r
    None\r
\r
--*/\r
{\r
  EFI_FW_VOL_INSTANCE *FwhInstance;\r
  UINTN               Index;\r
\r
  FwhInstance = mFvbModuleGlobal->FvInstance;\r
  EfiConvertPointer (0x0, (VOID **) &mFvbModuleGlobal->FvInstance);\r
\r
  //\r
  // Convert the base address of all the instances\r
  //\r
  Index       = 0;\r
  while (Index < mFvbModuleGlobal->NumFv) {\r
    EfiConvertPointer (0x0, (VOID **) &FwhInstance->FvBase);\r
    FwhInstance = (EFI_FW_VOL_INSTANCE *)\r
      (\r
        (UINTN) ((UINT8 *) FwhInstance) +\r
        FwhInstance->VolumeHeader.HeaderLength +\r
        (sizeof (EFI_FW_VOL_INSTANCE) - sizeof (EFI_FIRMWARE_VOLUME_HEADER))\r
      );\r
    Index++;\r
  }\r
\r
  EfiConvertPointer (0x0, (VOID **) &mFvbModuleGlobal);\r
  QemuFlashConvertPointers ();\r
}\r
\r
\r
VOID\r
InstallVirtualAddressChangeHandler (\r
  VOID\r
  )\r
{\r
  EFI_STATUS Status;\r
  EFI_EVENT  VirtualAddressChangeEvent;\r
\r
  Status = gBS->CreateEventEx (\r
                  EVT_NOTIFY_SIGNAL,\r
                  TPL_NOTIFY,\r
                  FvbVirtualAddressChangeEvent,\r
                  NULL,\r
                  &gEfiEventVirtualAddressChangeGuid,\r
                  &VirtualAddressChangeEvent\r
                  );\r
  ASSERT_EFI_ERROR (Status);\r
}\r