UefiCpuPkg: Move AsmRelocateApLoopStart from Mpfuncs.nasm to AmdSev.nasm

[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
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
**/\r
\r
#include <Guid/EventGroup.h>\r
#include <Library/DebugLib.h>\r
#include <Library/DevicePathLib.h>\r
#include <Library/DxeServicesTableLib.h>\r
#include <Library/MemEncryptSevLib.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 (\r
                  &gEfiFirmwareVolumeBlockProtocolGuid,\r
                  &FvbDevice->DevicePath,\r
                  &FwbHandle\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    //\r
    // LocateDevicePath fails so install a new interface and device path\r
    //\r
    FwbHandle = NULL;\r
    DEBUG ((DEBUG_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 ((DEBUG_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
STATIC\r
VOID\r
EFIAPI\r
FvbVirtualAddressChangeEvent (\r
  IN EFI_EVENT  Event,\r
  IN VOID       *Context\r
  )\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
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
\r
EFI_STATUS\r
MarkIoMemoryRangeForRuntimeAccess (\r
  IN EFI_PHYSICAL_ADDRESS  BaseAddress,\r
  IN UINTN                 Length\r
  )\r
{\r
  EFI_STATUS                       Status;\r
  EFI_GCD_MEMORY_SPACE_DESCRIPTOR  GcdDescriptor;\r
\r
  //\r
  // Mark flash region as runtime memory\r
  //\r
  Status = gDS->RemoveMemorySpace (\r
                  BaseAddress,\r
                  Length\r
                  );\r
\r
  Status = gDS->AddMemorySpace (\r
                  EfiGcdMemoryTypeMemoryMappedIo,\r
                  BaseAddress,\r
                  Length,\r
                  EFI_MEMORY_UC | EFI_MEMORY_RUNTIME\r
                  );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  Status = gDS->AllocateMemorySpace (\r
                  EfiGcdAllocateAddress,\r
                  EfiGcdMemoryTypeMemoryMappedIo,\r
                  0,\r
                  Length,\r
                  &BaseAddress,\r
                  gImageHandle,\r
                  NULL\r
                  );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  Status = gDS->GetMemorySpaceDescriptor (BaseAddress, &GcdDescriptor);\r
  ASSERT_EFI_ERROR (Status);\r
\r
  Status = gDS->SetMemorySpaceAttributes (\r
                  BaseAddress,\r
                  Length,\r
                  GcdDescriptor.Attributes | EFI_MEMORY_RUNTIME\r
                  );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  //\r
  // When SEV is active, AmdSevDxe mapped the BaseAddress with C=0 but\r
  // SetMemorySpaceAttributes() remaps the range with C=1. Let's restore\r
  // the mapping so that both guest and hyervisor can access the flash\r
  // memory range.\r
  //\r
  if (MemEncryptSevIsEnabled ()) {\r
    Status = MemEncryptSevClearMmioPageEncMask (\r
               0,\r
               BaseAddress,\r
               EFI_SIZE_TO_PAGES (Length)\r
               );\r
    ASSERT_EFI_ERROR (Status);\r
  }\r
\r
  return Status;\r
}\r
\r
VOID\r
SetPcdFlashNvStorageBaseAddresses (\r
  VOID\r
  )\r
{\r
  RETURN_STATUS  PcdStatus;\r
\r
  //\r
  // Set several PCD values to point to flash\r
  //\r
  PcdStatus = PcdSet64S (\r
                PcdFlashNvStorageVariableBase64,\r
                (UINTN)PcdGet32 (PcdOvmfFlashNvStorageVariableBase)\r
                );\r
  ASSERT_RETURN_ERROR (PcdStatus);\r
  PcdStatus = PcdSet32S (\r
                PcdFlashNvStorageFtwWorkingBase,\r
                PcdGet32 (PcdOvmfFlashNvStorageFtwWorkingBase)\r
                );\r
  ASSERT_RETURN_ERROR (PcdStatus);\r
  PcdStatus = PcdSet32S (\r
                PcdFlashNvStorageFtwSpareBase,\r
                PcdGet32 (PcdOvmfFlashNvStorageFtwSpareBase)\r
                );\r
  ASSERT_RETURN_ERROR (PcdStatus);\r
}\r