Signed-off by: rsun3 Reviewed-by: li-elvin git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@12354 6f19259b-4bc3-4df7-8a09-765794883524
		
			
				
	
	
		
			384 lines
		
	
	
		
			12 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			384 lines
		
	
	
		
			12 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /** @file
 | |
|   Pei Core Main Entry Point
 | |
|   
 | |
| Copyright (c) 2006 - 2011, 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 descriptor's pointer
 | |
|       //
 | |
|       ConvertPpiPointers (SecCoreData, OldCoreData);
 | |
| 
 | |
|       //
 | |
|       // 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();
 | |
| }
 |