1 files changed, 124 insertions, 0 deletions
diff --git a/roms/edk2/EmulatorPkg/FirmwareVolumePei/FirmwareVolumePei.c b/roms/edk2/EmulatorPkg/FirmwareVolumePei/FirmwareVolumePei.c
new file mode 100644
index 000000000..417811109
--- /dev/null
+++ b/roms/edk2/EmulatorPkg/FirmwareVolumePei/FirmwareVolumePei.c
@@ -0,0 +1,124 @@
+/*++ @file
+
+Copyright (c) 2006 - 2008, Intel Corporation. All rights reserved.<BR>
+Portions copyright (c) 2011, Apple Inc. All rights reserved.
+SPDX-License-Identifier: BSD-2-Clause-Patent
+
+**/
+
+#include "PiPei.h"
+#include <Ppi/EmuThunk.h>
+#include <Library/DebugLib.h>
+#include <Library/PeimEntryPoint.h>
+#include <Library/HobLib.h>
+#include <Library/PeiServicesLib.h>
+#include <Library/PeiServicesTablePointerLib.h>
+#include <Library/PcdLib.h>
+
+EFI_STATUS
+EFIAPI
+PeimInitializeFirmwareVolumePei (
+  IN       EFI_PEI_FILE_HANDLE       FileHandle,
+  IN CONST EFI_PEI_SERVICES          **PeiServices
+  )
+/*++
+
+Routine Description:
+  Perform a call-back into the SEC simulator to get address of the Firmware Hub
+
+Arguments:
+  FfsHeader   - Ffs Header available to every PEIM
+  PeiServices - General purpose services available to every PEIM.
+
+Returns:
+  None
+
+**/
+{
+  EFI_STATUS                  Status;
+  EFI_PEI_PPI_DESCRIPTOR      *PpiDescriptor;
+  EMU_THUNK_PPI               *Thunk;
+  EFI_PHYSICAL_ADDRESS        FdBase;
+  EFI_PHYSICAL_ADDRESS        FdFixUp;
+  EFI_FIRMWARE_VOLUME_HEADER  *FvHeader;
+  UINT64                      FdSize;
+  UINTN                       Index;
+
+  DEBUG ((EFI_D_ERROR, "Unix Firmware Volume PEIM Loaded\n"));
+
+  //
+  // Get the Fwh Information PPI
+  //
+  Status = PeiServicesLocatePpi (
+              &gEmuThunkPpiGuid,  // GUID
+              0,                  // INSTANCE
+              &PpiDescriptor,     // EFI_PEI_PPI_DESCRIPTOR
+              (VOID **)&Thunk     // PPI
+              );
+  ASSERT_EFI_ERROR (Status);
+
+  Index = 0;
+  do {
+    //
+    // Get information about all the FD's in the system
+    //
+    Status = Thunk->FirmwareDevices (Index, &FdBase, &FdSize, &FdFixUp);
+    if (!EFI_ERROR (Status)) {
+      //
+      // Assume the FD starts with an FV header
+      //
+      FvHeader = (EFI_FIRMWARE_VOLUME_HEADER *) (UINTN) FdBase;
+
+      //
+      // Make an FV Hob for the first FV in the FD
+      //
+      BuildFvHob (FdBase, FvHeader->FvLength);
+
+      if (Index == 0) {
+        //
+        // Assume the first FD was produced by the NT32.DSC
+        //  All these strange offests are needed to keep in
+        //  sync with the FlashMap and NT32.dsc file
+        //
+        BuildResourceDescriptorHob (
+          EFI_RESOURCE_FIRMWARE_DEVICE,
+          (EFI_RESOURCE_ATTRIBUTE_PRESENT | EFI_RESOURCE_ATTRIBUTE_INITIALIZED | EFI_RESOURCE_ATTRIBUTE_UNCACHEABLE),
+          FdBase,
+          (
+            FvHeader->FvLength +
+            PcdGet32 (PcdFlashNvStorageVariableSize) +
+            PcdGet32 (PcdFlashNvStorageFtwWorkingSize) +
+            PcdGet32 (PcdFlashNvStorageFtwSpareSize) +
+            PcdGet32 (PcdEmuFlashNvStorageEventLogSize)
+          )
+        );
+
+        //
+        // Hard code the address of the spare block and variable services.
+        //  Assume it's a hard coded offset from FV0 in FD0.
+        //
+        FdSize  =
+          PcdGet32 (PcdFlashNvStorageVariableSize) +
+          PcdGet32 (PcdFlashNvStorageFtwWorkingSize) +
+          PcdGet32 (PcdFlashNvStorageFtwSpareSize) +
+          PcdGet32 (PcdEmuFlashNvStorageEventLogSize);
+
+        BuildFvHob (FdFixUp + PcdGet64 (PcdEmuFlashNvStorageVariableBase), FdSize);
+      } else {
+        //
+        // For other FD's just map them in.
+        //
+        BuildResourceDescriptorHob (
+          EFI_RESOURCE_FIRMWARE_DEVICE,
+          (EFI_RESOURCE_ATTRIBUTE_PRESENT | EFI_RESOURCE_ATTRIBUTE_INITIALIZED | EFI_RESOURCE_ATTRIBUTE_UNCACHEABLE),
+          FdBase,
+          FdSize
+          );
+      }
+    }
+
+    Index++;
+  } while (!EFI_ERROR (Status));
+
+  return Status;
+}