2) Add ProcessLibraryConstructorList() call when OldCoreData != NULL and OldCoreData->ShadowedPeiCore == NULL. 3) Make sure no lib functions are used prior to the ProcessLibraryConstructorList() call. 4) Clean up comments git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@10611 6f19259b-4bc3-4df7-8a09-765794883524
		
			
				
	
	
		
			384 lines
		
	
	
		
			12 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			384 lines
		
	
	
		
			12 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/** @file
 | 
						|
  Pei Core Main Entry Point
 | 
						|
  
 | 
						|
Copyright (c) 2006 - 2010, 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 "PeiMain.h"
 | 
						|
 | 
						|
EFI_PEI_PPI_DESCRIPTOR mMemoryDiscoveredPpi = {
 | 
						|
  (EFI_PEI_PPI_DESCRIPTOR_PPI | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST),
 | 
						|
  &gEfiPeiMemoryDiscoveredPpiGuid,
 | 
						|
  NULL
 | 
						|
};
 | 
						|
 | 
						|
///
 | 
						|
/// Pei service instance
 | 
						|
///
 | 
						|
EFI_PEI_SERVICES  gPs = {
 | 
						|
  {
 | 
						|
    PEI_SERVICES_SIGNATURE,
 | 
						|
    PEI_SERVICES_REVISION,
 | 
						|
    sizeof (EFI_PEI_SERVICES),
 | 
						|
    0,
 | 
						|
    0
 | 
						|
  },
 | 
						|
  PeiInstallPpi,
 | 
						|
  PeiReInstallPpi,
 | 
						|
  PeiLocatePpi,
 | 
						|
  PeiNotifyPpi,
 | 
						|
 | 
						|
  PeiGetBootMode,
 | 
						|
  PeiSetBootMode,
 | 
						|
 | 
						|
  PeiGetHobList,
 | 
						|
  PeiCreateHob,
 | 
						|
 | 
						|
  PeiFfsFindNextVolume,
 | 
						|
  PeiFfsFindNextFile,
 | 
						|
  PeiFfsFindSectionData,
 | 
						|
 | 
						|
  PeiInstallPeiMemory,      
 | 
						|
  PeiAllocatePages,
 | 
						|
  PeiAllocatePool,
 | 
						|
  (EFI_PEI_COPY_MEM)CopyMem,
 | 
						|
  (EFI_PEI_SET_MEM)SetMem,
 | 
						|
 | 
						|
  PeiReportStatusCode,
 | 
						|
  PeiResetSystem,
 | 
						|
 | 
						|
  &gPeiDefaultCpuIoPpi,
 | 
						|
  &gPeiDefaultPciCfg2Ppi,
 | 
						|
 | 
						|
  PeiFfsFindFileByName,
 | 
						|
  PeiFfsGetFileInfo,
 | 
						|
  PeiFfsGetVolumeInfo,
 | 
						|
  PeiRegisterForShadow
 | 
						|
};
 | 
						|
 | 
						|
/**
 | 
						|
  Shadow PeiCore module from flash to installed memory.
 | 
						|
  
 | 
						|
  @param PrivateData    PeiCore's private data structure
 | 
						|
 | 
						|
  @return PeiCore function address after shadowing.
 | 
						|
**/
 | 
						|
PEICORE_FUNCTION_POINTER
 | 
						|
ShadowPeiCore (
 | 
						|
  IN PEI_CORE_INSTANCE  *PrivateData
 | 
						|
  )
 | 
						|
{
 | 
						|
  EFI_PEI_FILE_HANDLE  PeiCoreFileHandle;
 | 
						|
  EFI_PHYSICAL_ADDRESS EntryPoint;
 | 
						|
  EFI_STATUS           Status;
 | 
						|
  UINT32               AuthenticationState;
 | 
						|
 | 
						|
  PeiCoreFileHandle = NULL;
 | 
						|
 | 
						|
  //
 | 
						|
  // Find the PEI Core in the BFV
 | 
						|
  //
 | 
						|
  Status = PrivateData->Fv[0].FvPpi->FindFileByType (
 | 
						|
                                       PrivateData->Fv[0].FvPpi,
 | 
						|
                                       EFI_FV_FILETYPE_PEI_CORE,
 | 
						|
                                       PrivateData->Fv[0].FvHandle,
 | 
						|
                                       &PeiCoreFileHandle
 | 
						|
                                       );
 | 
						|
  ASSERT_EFI_ERROR (Status);
 | 
						|
 | 
						|
  //
 | 
						|
  // Shadow PEI Core into memory so it will run faster
 | 
						|
  //
 | 
						|
  Status = PeiLoadImage (
 | 
						|
              GetPeiServicesTablePointer (),
 | 
						|
              *((EFI_PEI_FILE_HANDLE*)&PeiCoreFileHandle),
 | 
						|
              PEIM_STATE_REGISITER_FOR_SHADOW,
 | 
						|
              &EntryPoint,
 | 
						|
              &AuthenticationState
 | 
						|
              );
 | 
						|
  ASSERT_EFI_ERROR (Status);
 | 
						|
 | 
						|
  //
 | 
						|
  // Compute the PeiCore's function address after shaowed PeiCore.
 | 
						|
  // _ModuleEntryPoint is PeiCore main function entry
 | 
						|
  //
 | 
						|
  return (PEICORE_FUNCTION_POINTER)((UINTN) EntryPoint + (UINTN) PeiCore - (UINTN) _ModuleEntryPoint);
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
  This routine is invoked by main entry of PeiMain module during transition
 | 
						|
  from SEC to PEI. After switching stack in the PEI core, it will restart
 | 
						|
  with the old core data.
 | 
						|
 | 
						|
  @param SecCoreData     Points to a data structure containing information about the PEI core's operating
 | 
						|
                         environment, such as the size and location of temporary RAM, the stack location and
 | 
						|
                         the BFV location.
 | 
						|
  @param PpiList         Points to a list of one or more PPI descriptors to be installed initially by the PEI core.
 | 
						|
                         An empty PPI list consists of a single descriptor with the end-tag
 | 
						|
                         EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST. As part of its initialization
 | 
						|
                         phase, the PEI Foundation will add these SEC-hosted PPIs to its PPI database such
 | 
						|
                         that both the PEI Foundation and any modules can leverage the associated service
 | 
						|
                         calls and/or code in these early PPIs
 | 
						|
  @param Data            Pointer to old core data that is used to initialize the
 | 
						|
                         core's data areas.
 | 
						|
                         If NULL, it is first PeiCore entering.
 | 
						|
 | 
						|
**/
 | 
						|
VOID
 | 
						|
EFIAPI
 | 
						|
PeiCore (
 | 
						|
  IN CONST EFI_SEC_PEI_HAND_OFF        *SecCoreData,
 | 
						|
  IN CONST EFI_PEI_PPI_DESCRIPTOR      *PpiList,
 | 
						|
  IN VOID                              *Data
 | 
						|
  )
 | 
						|
{
 | 
						|
  PEI_CORE_INSTANCE           PrivateData;
 | 
						|
  EFI_STATUS                  Status;
 | 
						|
  PEI_CORE_TEMP_POINTERS      TempPtr;
 | 
						|
  PEI_CORE_INSTANCE           *OldCoreData;
 | 
						|
  EFI_PEI_CPU_IO_PPI          *CpuIo;
 | 
						|
  EFI_PEI_PCI_CFG2_PPI        *PciCfg;
 | 
						|
  EFI_HOB_HANDOFF_INFO_TABLE  *HandoffInformationTable;
 | 
						|
 | 
						|
  //
 | 
						|
  // Retrieve context passed into PEI Core
 | 
						|
  //
 | 
						|
  OldCoreData = (PEI_CORE_INSTANCE *)Data;
 | 
						|
 | 
						|
  //
 | 
						|
  // Perform PEI Core phase specific actions.
 | 
						|
  //
 | 
						|
  if (OldCoreData == NULL) {
 | 
						|
    //
 | 
						|
    // If OldCoreData is NULL, means current is the first entry into the PEI Core before memory is available.
 | 
						|
    //
 | 
						|
    ZeroMem (&PrivateData, sizeof (PEI_CORE_INSTANCE));
 | 
						|
    PrivateData.Signature = PEI_CORE_HANDLE_SIGNATURE;
 | 
						|
    CopyMem (&PrivateData.ServiceTableShadow, &gPs, sizeof (gPs));
 | 
						|
  } else {
 | 
						|
    //
 | 
						|
    // Memory is available to the PEI Core.  See if the PEI Core has been shadowed to memory yet.
 | 
						|
    //
 | 
						|
    if (OldCoreData->ShadowedPeiCore == NULL) {
 | 
						|
      //
 | 
						|
      // Fixup the PeiCore's private data
 | 
						|
      //
 | 
						|
      OldCoreData->Ps    = &OldCoreData->ServiceTableShadow;
 | 
						|
      OldCoreData->CpuIo = &OldCoreData->ServiceTableShadow.CpuIo;
 | 
						|
      if (OldCoreData->HeapOffsetPositive) {
 | 
						|
        OldCoreData->HobList.Raw = (VOID *)(OldCoreData->HobList.Raw + OldCoreData->HeapOffset);
 | 
						|
      } else {
 | 
						|
        OldCoreData->HobList.Raw = (VOID *)(OldCoreData->HobList.Raw - OldCoreData->HeapOffset);
 | 
						|
      }
 | 
						|
 | 
						|
      //
 | 
						|
      // Initialize libraries that the PEI Core is linked against
 | 
						|
      //
 | 
						|
      ProcessLibraryConstructorList (NULL, (CONST EFI_PEI_SERVICES **)&OldCoreData->Ps);
 | 
						|
      
 | 
						|
      //
 | 
						|
      // Fixup for PeiService's address
 | 
						|
      //
 | 
						|
      SetPeiServicesTablePointer ((CONST EFI_PEI_SERVICES **)&OldCoreData->Ps);
 | 
						|
 | 
						|
      //
 | 
						|
      // Update HandOffHob for new installed permenent memory
 | 
						|
      //
 | 
						|
      HandoffInformationTable = OldCoreData->HobList.HandoffInformationTable;
 | 
						|
      if (OldCoreData->HeapOffsetPositive) {
 | 
						|
        HandoffInformationTable->EfiEndOfHobList   = HandoffInformationTable->EfiEndOfHobList + OldCoreData->HeapOffset;
 | 
						|
      } else {
 | 
						|
        HandoffInformationTable->EfiEndOfHobList   = HandoffInformationTable->EfiEndOfHobList - OldCoreData->HeapOffset;
 | 
						|
      }
 | 
						|
      HandoffInformationTable->EfiMemoryTop        = OldCoreData->PhysicalMemoryBegin + OldCoreData->PhysicalMemoryLength;
 | 
						|
      HandoffInformationTable->EfiMemoryBottom     = OldCoreData->PhysicalMemoryBegin;
 | 
						|
      HandoffInformationTable->EfiFreeMemoryTop    = OldCoreData->FreePhysicalMemoryTop;
 | 
						|
      HandoffInformationTable->EfiFreeMemoryBottom = HandoffInformationTable->EfiEndOfHobList + sizeof (EFI_HOB_GENERIC_HEADER);
 | 
						|
 | 
						|
      //
 | 
						|
      // We need convert the PPI desciptor's pointer
 | 
						|
      //
 | 
						|
      ConvertPpiPointers (OldCoreData, (UINTN)SecCoreData->TemporaryRamBase, (UINTN)SecCoreData->TemporaryRamBase + SecCoreData->TemporaryRamSize, OldCoreData->HeapOffset, OldCoreData->HeapOffsetPositive);
 | 
						|
 | 
						|
      //
 | 
						|
      // After the whole temporary memory is migrated, then we can allocate page in
 | 
						|
      // permenent memory.
 | 
						|
      //
 | 
						|
      OldCoreData->PeiMemoryInstalled = TRUE;
 | 
						|
 | 
						|
      //
 | 
						|
      // Indicate that PeiCore reenter
 | 
						|
      //
 | 
						|
      OldCoreData->PeimDispatcherReenter = TRUE;
 | 
						|
      
 | 
						|
      if (PcdGet64(PcdLoadModuleAtFixAddressEnable) != 0 && (OldCoreData->HobList.HandoffInformationTable->BootMode != BOOT_ON_S3_RESUME)) {
 | 
						|
        //
 | 
						|
        // if Loading Module at Fixed Address is enabled, allocate the PEI code memory range usage bit map array.
 | 
						|
        // Every bit in the array indicate the status of the corresponding memory page available or not
 | 
						|
        //
 | 
						|
        OldCoreData->PeiCodeMemoryRangeUsageBitMap = AllocateZeroPool (((PcdGet32(PcdLoadFixAddressPeiCodePageNumber)>>6) + 1)*sizeof(UINT64));
 | 
						|
      }
 | 
						|
 | 
						|
      //
 | 
						|
      // Shadow PEI Core. When permanent memory is avaiable, shadow
 | 
						|
      // PEI Core and PEIMs to get high performance.
 | 
						|
      //
 | 
						|
      OldCoreData->ShadowedPeiCore = ShadowPeiCore (OldCoreData);
 | 
						|
      
 | 
						|
      //
 | 
						|
      // PEI Core has now been shadowed to memory.  Restart PEI Core in memory.
 | 
						|
      //
 | 
						|
      OldCoreData->ShadowedPeiCore (SecCoreData, PpiList, OldCoreData);
 | 
						|
      
 | 
						|
      //
 | 
						|
      // Should never reach here.
 | 
						|
      //
 | 
						|
      ASSERT (FALSE);
 | 
						|
      CpuDeadLoop();
 | 
						|
    }
 | 
						|
 | 
						|
    //
 | 
						|
    // Memory is available to the PEI Core and the PEI Core has been shadowed to memory.
 | 
						|
    //
 | 
						|
    
 | 
						|
    CopyMem (&PrivateData, OldCoreData, sizeof (PrivateData));
 | 
						|
    
 | 
						|
    CpuIo = (VOID*)PrivateData.ServiceTableShadow.CpuIo;
 | 
						|
    PciCfg = (VOID*)PrivateData.ServiceTableShadow.PciCfg;
 | 
						|
    
 | 
						|
    CopyMem (&PrivateData.ServiceTableShadow, &gPs, sizeof (gPs));
 | 
						|
    
 | 
						|
    PrivateData.ServiceTableShadow.CpuIo  = CpuIo;
 | 
						|
    PrivateData.ServiceTableShadow.PciCfg = PciCfg;
 | 
						|
  }
 | 
						|
  
 | 
						|
  //
 | 
						|
  // Cache a pointer to the PEI Services Table that is either in temporary memory or permanent memory
 | 
						|
  //
 | 
						|
  PrivateData.Ps = &PrivateData.ServiceTableShadow;
 | 
						|
 | 
						|
  //
 | 
						|
  // Initialize libraries that the PEI Core is linked against
 | 
						|
  //
 | 
						|
  ProcessLibraryConstructorList (NULL, (CONST EFI_PEI_SERVICES **)&PrivateData.Ps);
 | 
						|
 | 
						|
  //
 | 
						|
  // Save PeiServicePointer so that it can be retrieved anywhere.
 | 
						|
  //
 | 
						|
  SetPeiServicesTablePointer ((CONST EFI_PEI_SERVICES **)&PrivateData.Ps);
 | 
						|
 | 
						|
  //
 | 
						|
  // Initialize PEI Core Services
 | 
						|
  //  
 | 
						|
  InitializeMemoryServices   (&PrivateData,    SecCoreData, OldCoreData);
 | 
						|
  InitializePpiServices      (&PrivateData,    OldCoreData);
 | 
						|
  
 | 
						|
  //
 | 
						|
  // Update performance measurements 
 | 
						|
  //
 | 
						|
  if (OldCoreData == NULL) {
 | 
						|
    PERF_START (NULL, "SEC", NULL, 1);
 | 
						|
    PERF_END   (NULL, "SEC", NULL, 0);
 | 
						|
 | 
						|
    //
 | 
						|
    // If first pass, start performance measurement.
 | 
						|
    //
 | 
						|
    PERF_START (NULL,"PEI",    NULL, 0);
 | 
						|
    PERF_START (NULL,"PreMem", NULL, 0);
 | 
						|
 | 
						|
  } else {
 | 
						|
    PERF_END   (NULL,"PreMem",  NULL, 0);
 | 
						|
    PERF_START (NULL,"PostMem", NULL, 0);
 | 
						|
  }
 | 
						|
 | 
						|
  //
 | 
						|
  // Complete PEI Core Service initialization
 | 
						|
  //  
 | 
						|
  InitializeSecurityServices (&PrivateData.Ps, OldCoreData);
 | 
						|
  InitializeDispatcherData   (&PrivateData,    OldCoreData, SecCoreData);
 | 
						|
  InitializeImageServices    (&PrivateData,    OldCoreData);
 | 
						|
 | 
						|
  //
 | 
						|
  // Perform PEI Core Phase specific actions
 | 
						|
  //  
 | 
						|
  if (OldCoreData == NULL) {
 | 
						|
    //
 | 
						|
    // Report Status Code EFI_SW_PC_INIT
 | 
						|
    //
 | 
						|
    REPORT_STATUS_CODE (
 | 
						|
      EFI_PROGRESS_CODE,
 | 
						|
      (EFI_SOFTWARE_PEI_CORE | EFI_SW_PC_INIT)
 | 
						|
      );
 | 
						|
      
 | 
						|
    //
 | 
						|
    // If SEC provided any PPI services to PEI, install them.
 | 
						|
    //
 | 
						|
    if (PpiList != NULL) {
 | 
						|
      Status = PeiServicesInstallPpi (PpiList);
 | 
						|
      ASSERT_EFI_ERROR (Status);
 | 
						|
    }
 | 
						|
  } else {
 | 
						|
    //
 | 
						|
    // Alert any listeners that there is permanent memory available
 | 
						|
    //
 | 
						|
    PERF_START (NULL,"DisMem", NULL, 0);
 | 
						|
    Status = PeiServicesInstallPpi (&mMemoryDiscoveredPpi);
 | 
						|
 | 
						|
    //
 | 
						|
    // Process the Notify list and dispatch any notifies for the Memory Discovered PPI
 | 
						|
    //
 | 
						|
    ProcessNotifyList (&PrivateData);
 | 
						|
 | 
						|
    PERF_END (NULL,"DisMem", NULL, 0);
 | 
						|
  }
 | 
						|
 | 
						|
  //
 | 
						|
  // Call PEIM dispatcher
 | 
						|
  //
 | 
						|
  PeiDispatcher (SecCoreData, &PrivateData);
 | 
						|
 | 
						|
  //
 | 
						|
  // Check if InstallPeiMemory service was called.
 | 
						|
  //
 | 
						|
  ASSERT(PrivateData.PeiMemoryInstalled == TRUE);
 | 
						|
 | 
						|
  //
 | 
						|
  // Measure PEI Core execution time.
 | 
						|
  //
 | 
						|
  PERF_END (NULL, "PostMem", NULL, 0);
 | 
						|
 | 
						|
  //
 | 
						|
  // Lookup DXE IPL PPI
 | 
						|
  //
 | 
						|
  Status = PeiServicesLocatePpi (
 | 
						|
             &gEfiDxeIplPpiGuid,
 | 
						|
             0,
 | 
						|
             NULL,
 | 
						|
             (VOID **)&TempPtr.DxeIpl
 | 
						|
             );
 | 
						|
  ASSERT_EFI_ERROR (Status);
 | 
						|
 | 
						|
  //
 | 
						|
  // Enter DxeIpl to load Dxe core.
 | 
						|
  //
 | 
						|
  DEBUG ((EFI_D_INFO, "DXE IPL Entry\n"));
 | 
						|
  Status = TempPtr.DxeIpl->Entry (
 | 
						|
                             TempPtr.DxeIpl,
 | 
						|
                             &PrivateData.Ps,
 | 
						|
                             PrivateData.HobList
 | 
						|
                             );
 | 
						|
  //
 | 
						|
  // Should never reach here.
 | 
						|
  //
 | 
						|
  ASSERT_EFI_ERROR (Status);
 | 
						|
  CpuDeadLoop();
 | 
						|
}
 |