X-Git-Url: https://git.proxmox.com/?p=mirror_edk2.git;a=blobdiff_plain;f=IntelFspWrapperPkg%2FFspInitPei%2FFspInitPeiV1.c;fp=IntelFspWrapperPkg%2FFspInitPei%2FFspInitPeiV1.c;h=f6ffecb2cafef4e203e5f516c10332fc2ef97093;hp=0000000000000000000000000000000000000000;hb=d8043ce905a5832f911361ef30be28765afbdc6b;hpb=d5fb1edfb16a2af29486ffbf5aa32a036da9caa4

diff --git a/IntelFspWrapperPkg/FspInitPei/FspInitPeiV1.c b/IntelFspWrapperPkg/FspInitPei/FspInitPeiV1.c
new file mode 100644
index 0000000000..f6ffecb2ca
--- /dev/null
+++ b/IntelFspWrapperPkg/FspInitPei/FspInitPeiV1.c
@@ -0,0 +1,181 @@
+/** @file
+  In FSP API V1 mode, it will be invoked twice by pei core. In 1st entry, it will
+  call FspInit API. In 2nd entry, it will parse the hoblist from fsp and report
+  them into pei core.
+
+  Copyright (c) 2015, Intel Corporation. All rights reserved.<BR>
+  This program and the accompanying materials
+  are licensed and made available under the terms and conditions of the BSD License
+  which accompanies this distribution.  The full text of the license may be found at
+  http://opensource.org/licenses/bsd-license.php.
+
+  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
+  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
+
+**/
+
+
+#include "FspInitPei.h"
+
+/**
+  FSP Init continuation function.
+  Control will be returned to this callback function after FspInit API call.
+
+  @param[in] Status      Status of the FSP INIT API
+  @param[in] HobListPtr  Pointer to the HOB data structure defined in the PI specification.
+
+**/
+VOID
+ContinuationFunc (
+  IN EFI_STATUS Status,
+  IN VOID       *HobListPtr
+  )
+{
+  EFI_BOOT_MODE             BootMode;
+  UINT64                    StackSize;
+  EFI_PHYSICAL_ADDRESS      StackBase;
+
+  DEBUG ((DEBUG_INFO, "ContinuationFunc - %r\n", Status));
+  DEBUG ((DEBUG_INFO, "HobListPtr - 0x%x\n", HobListPtr));
+
+  if (Status != EFI_SUCCESS) {
+    CpuDeadLoop ();
+  }
+
+  //
+  // Can not call any PeiServices
+  //
+  BootMode = GetBootMode ();
+
+  GetStackInfo (BootMode, TRUE, &StackBase, &StackSize);
+  DEBUG ((DEBUG_INFO, "StackBase - 0x%x\n", StackBase));
+  DEBUG ((DEBUG_INFO, "StackSize - 0x%x\n", StackSize));
+  CallPeiCoreEntryPoint (
+    HobListPtr,
+    (VOID *)(UINTN)StackBase,
+    (VOID *)(UINTN)(StackBase + StackSize)
+    );
+}
+
+/**
+  Call FspInit API.
+
+  @param[in] FspHeader FSP header pointer.
+**/
+VOID
+PeiFspInit (
+  IN FSP_INFO_HEADER *FspHeader
+  )
+{
+  FSP_INIT_PARAMS           FspInitParams;
+  FSP_INIT_RT_COMMON_BUFFER FspRtBuffer;
+  UINT8                     FspUpdRgn[FixedPcdGet32 (PcdMaxUpdRegionSize)];
+  UINT32                    UpdRegionSize;
+  EFI_BOOT_MODE             BootMode;
+  UINT64                    StackSize;
+  EFI_PHYSICAL_ADDRESS      StackBase;
+  EFI_STATUS                Status;
+
+  DEBUG ((DEBUG_INFO, "PeiFspInit enter\n"));
+
+  PeiServicesGetBootMode (&BootMode);
+  DEBUG ((DEBUG_INFO, "BootMode - 0x%x\n", BootMode));
+
+  GetStackInfo (BootMode, FALSE, &StackBase, &StackSize);
+  DEBUG ((DEBUG_INFO, "StackBase - 0x%x\n", StackBase));
+  DEBUG ((DEBUG_INFO, "StackSize - 0x%x\n", StackSize));
+
+  ZeroMem (&FspRtBuffer, sizeof(FspRtBuffer));
+  FspRtBuffer.StackTop = (UINT32 *)(UINTN)(StackBase + StackSize);
+
+  FspRtBuffer.BootMode = BootMode;
+
+  /* Platform override any UPD configs */
+  UpdRegionSize = GetUpdRegionSize();
+  DEBUG ((DEBUG_INFO, "UpdRegionSize - 0x%x\n", UpdRegionSize));
+  DEBUG ((DEBUG_INFO, "sizeof(FspUpdRgn) - 0x%x\n", sizeof(FspUpdRgn)));
+  ASSERT(sizeof(FspUpdRgn) >= UpdRegionSize);
+  ZeroMem (FspUpdRgn, UpdRegionSize);
+  FspRtBuffer.UpdDataRgnPtr = UpdateFspUpdConfigs (FspUpdRgn);
+
+  ZeroMem (&FspInitParams, sizeof(FspInitParams));
+  FspInitParams.NvsBufferPtr = GetNvsBuffer ();
+  DEBUG ((DEBUG_INFO, "NvsBufferPtr - 0x%x\n", FspInitParams.NvsBufferPtr));
+  FspInitParams.RtBufferPtr  = (VOID *)&FspRtBuffer;
+  FspInitParams.ContinuationFunc = (CONTINUATION_PROC)ContinuationFunc;
+
+  SaveSecContext (GetPeiServicesTablePointer ());
+
+  DEBUG ((DEBUG_INFO, "FspInitParams      - 0x%x\n", &FspInitParams));
+  DEBUG ((DEBUG_INFO, "  NvsBufferPtr     - 0x%x\n", FspInitParams.NvsBufferPtr));
+  DEBUG ((DEBUG_INFO, "  RtBufferPtr      - 0x%x\n", FspInitParams.RtBufferPtr));
+  DEBUG ((DEBUG_INFO, "    StackTop       - 0x%x\n", FspRtBuffer.StackTop));
+  DEBUG ((DEBUG_INFO, "    BootMode       - 0x%x\n", FspRtBuffer.BootMode));
+  DEBUG ((DEBUG_INFO, "    UpdDataRgnPtr  - 0x%x\n", FspRtBuffer.UpdDataRgnPtr));
+  DEBUG ((DEBUG_INFO, "  ContinuationFunc - 0x%x\n", FspInitParams.ContinuationFunc));
+
+  Status = CallFspInit (FspHeader, &FspInitParams);
+  //
+  // Should never return
+  //
+  DEBUG((DEBUG_ERROR, "FSP Init failed, status: 0x%x\n", Status));
+  CpuDeadLoop ();
+}
+
+/**
+  Do FSP initialization based on FspApi version 1.
+
+  @param[in] FspHeader FSP header pointer.
+
+  @return FSP initialization status.
+**/
+EFI_STATUS
+PeiFspInitV1 (
+  IN FSP_INFO_HEADER *FspHeader
+  )
+{
+  EFI_STATUS           Status;
+  FSP_INIT_DONE_PPI    *FspInitDone;
+  VOID                 *FspHobList;
+  EFI_BOOT_MODE        BootMode;
+  
+  Status = PeiServicesLocatePpi (
+             &gFspInitDonePpiGuid,
+             0,
+             NULL,
+             (VOID **) &FspInitDone
+             );
+  if (EFI_ERROR (Status)) {
+    //
+    // 1st entry
+    //
+    DEBUG ((DEBUG_INFO, "1st entry\n"));
+
+    PeiFspInit (FspHeader);
+    //
+    // Never return here, for FspApi version 1.
+    //
+    CpuDeadLoop ();
+  } else {
+    //
+    // 2nd entry for FspApi version 1 only.
+    //
+    DEBUG ((DEBUG_INFO, "2nd entry\n"));
+
+    Status = FspInitDone->GetFspHobList (GetPeiServicesTablePointer (), FspInitDone, &FspHobList);
+    ASSERT_EFI_ERROR (Status);
+    DEBUG ((DEBUG_INFO, "FspHobList - 0x%x\n", FspHobList));
+    FspHobProcess (FspHobList);
+    
+    //
+    // Register EndOfPei Notify for S3 to run FspNotifyPhase
+    //
+    PeiServicesGetBootMode (&BootMode);
+    if (BootMode == BOOT_ON_S3_RESUME) {
+      Status = PeiServicesNotifyPpi (&mS3EndOfPeiNotifyDesc);
+      ASSERT_EFI_ERROR (Status);
+    }
+  }
+
+  return EFI_SUCCESS;
+}
\ No newline at end of file