123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250 |
- /** @file
- Copyright (c) 2008 - 2009, Apple Inc. All rights reserved.<BR>
- Copyright (c) 2016 HP Development Company, L.P.
- Copyright (c) 2016 - 2021, Arm Limited. All rights reserved.
- SPDX-License-Identifier: BSD-2-Clause-Patent
- **/
- #include <Base.h>
- #include <Pi/PiMmCis.h>
- #include <Library/Arm/StandaloneMmCoreEntryPoint.h>
- #include <Library/DebugLib.h>
- #include <Library/ArmSvcLib.h>
- #include <Library/ArmLib.h>
- #include <Library/BaseMemoryLib.h>
- #include <Library/HobLib.h>
- #include <Protocol/DebugSupport.h> // for EFI_SYSTEM_CONTEXT
- #include <Guid/ZeroGuid.h>
- #include <Guid/MmramMemoryReserve.h>
- #include "StandaloneMmCpu.h"
- // GUID to identify HOB with whereabouts of communication buffer with Normal
- // World
- extern EFI_GUID gEfiStandaloneMmNonSecureBufferGuid;
- // GUID to identify HOB where the entry point of this CPU driver will be
- // populated to allow the entry point driver to invoke it upon receipt of an
- // event
- extern EFI_GUID gEfiArmTfCpuDriverEpDescriptorGuid;
- //
- // Private copy of the MM system table for future use
- //
- EFI_MM_SYSTEM_TABLE *mMmst = NULL;
- //
- // Globals used to initialize the protocol
- //
- STATIC EFI_HANDLE mMmCpuHandle = NULL;
- /** Returns the HOB data for the matching HOB GUID.
- @param [in] HobList Pointer to the HOB list.
- @param [in] HobGuid The GUID for the HOB.
- @param [out] HobData Pointer to the HOB data.
- @retval EFI_SUCCESS The function completed successfully.
- @retval EFI_INVALID_PARAMETER Invalid parameter.
- @retval EFI_NOT_FOUND Could not find HOB with matching GUID.
- **/
- EFI_STATUS
- GetGuidedHobData (
- IN VOID *HobList,
- IN CONST EFI_GUID *HobGuid,
- OUT VOID **HobData
- )
- {
- EFI_HOB_GUID_TYPE *Hob;
- if ((HobList == NULL) || (HobGuid == NULL) || (HobData == NULL)) {
- return EFI_INVALID_PARAMETER;
- }
- Hob = GetNextGuidHob (HobGuid, HobList);
- if (Hob == NULL) {
- return EFI_NOT_FOUND;
- }
- *HobData = GET_GUID_HOB_DATA (Hob);
- if (*HobData == NULL) {
- return EFI_NOT_FOUND;
- }
- return EFI_SUCCESS;
- }
- /** Entry point for the Standalone MM CPU driver.
- @param [in] ImageHandle Unused. Not actual image handle.
- @param [in] SystemTable Pointer to MM System table.
- @retval EFI_SUCCESS The function completed successfully.
- @retval EFI_INVALID_PARAMETER Invalid parameter.
- @retval EFI_OUT_OF_RESOURCES Out of resources.
- @retval EFI_NOT_FOUND Failed to find the HOB for the CPU
- driver endpoint descriptor.
- **/
- EFI_STATUS
- StandaloneMmCpuInitialize (
- IN EFI_HANDLE ImageHandle, // not actual imagehandle
- IN EFI_MM_SYSTEM_TABLE *SystemTable // not actual systemtable
- )
- {
- ARM_TF_CPU_DRIVER_EP_DESCRIPTOR *CpuDriverEntryPointDesc;
- EFI_CONFIGURATION_TABLE *ConfigurationTable;
- MP_INFORMATION_HOB_DATA *MpInformationHobData;
- EFI_MMRAM_DESCRIPTOR *NsCommBufMmramRange;
- EFI_STATUS Status;
- EFI_HANDLE DispatchHandle;
- UINT32 MpInfoSize;
- UINTN Index;
- UINTN ArraySize;
- VOID *HobStart;
- ASSERT (SystemTable != NULL);
- mMmst = SystemTable;
- // publish the MM config protocol so the MM core can register its entry point
- Status = mMmst->MmInstallProtocolInterface (
- &mMmCpuHandle,
- &gEfiMmConfigurationProtocolGuid,
- EFI_NATIVE_INTERFACE,
- &mMmConfig
- );
- if (EFI_ERROR (Status)) {
- return Status;
- }
- // register the root MMI handler
- Status = mMmst->MmiHandlerRegister (
- PiMmCpuTpFwRootMmiHandler,
- NULL,
- &DispatchHandle
- );
- if (EFI_ERROR (Status)) {
- return Status;
- }
- // Retrieve the Hoblist from the MMST to extract the details of the NS
- // communication buffer that has been reserved by S-EL1/EL3
- ConfigurationTable = mMmst->MmConfigurationTable;
- for (Index = 0; Index < mMmst->NumberOfTableEntries; Index++) {
- if (CompareGuid (&gEfiHobListGuid, &(ConfigurationTable[Index].VendorGuid))) {
- break;
- }
- }
- // Bail out if the Hoblist could not be found
- if (Index >= mMmst->NumberOfTableEntries) {
- DEBUG ((DEBUG_INFO, "Hoblist not found - 0x%x\n", Index));
- return EFI_OUT_OF_RESOURCES;
- }
- HobStart = ConfigurationTable[Index].VendorTable;
- //
- // Locate the HOB with the buffer to populate the entry point of this driver
- //
- Status = GetGuidedHobData (
- HobStart,
- &gEfiArmTfCpuDriverEpDescriptorGuid,
- (VOID **) &CpuDriverEntryPointDesc
- );
- if (EFI_ERROR (Status)) {
- DEBUG ((DEBUG_INFO, "ArmTfCpuDriverEpDesc HOB data extraction failed - 0x%x\n", Status));
- return Status;
- }
- // Share the entry point of the CPU driver
- DEBUG ((DEBUG_INFO, "Sharing Cpu Driver EP *0x%lx = 0x%lx\n",
- (UINTN) CpuDriverEntryPointDesc->ArmTfCpuDriverEpPtr,
- (UINTN) PiMmStandaloneArmTfCpuDriverEntry));
- *(CpuDriverEntryPointDesc->ArmTfCpuDriverEpPtr) = PiMmStandaloneArmTfCpuDriverEntry;
- // Find the descriptor that contains the whereabouts of the buffer for
- // communication with the Normal world.
- Status = GetGuidedHobData (
- HobStart,
- &gEfiStandaloneMmNonSecureBufferGuid,
- (VOID **) &NsCommBufMmramRange
- );
- if (EFI_ERROR (Status)) {
- DEBUG ((DEBUG_INFO, "NsCommBufMmramRange HOB data extraction failed - 0x%x\n", Status));
- return Status;
- }
- DEBUG ((DEBUG_INFO, "mNsCommBuffer.PhysicalStart - 0x%lx\n", (UINTN) NsCommBufMmramRange->PhysicalStart));
- DEBUG ((DEBUG_INFO, "mNsCommBuffer.PhysicalSize - 0x%lx\n", (UINTN) NsCommBufMmramRange->PhysicalSize));
- CopyMem (&mNsCommBuffer, NsCommBufMmramRange, sizeof(EFI_MMRAM_DESCRIPTOR));
- DEBUG ((DEBUG_INFO, "mNsCommBuffer: 0x%016lx - 0x%lx\n", mNsCommBuffer.CpuStart, mNsCommBuffer.PhysicalSize));
- //
- // Extract the MP information from the Hoblist
- //
- Status = GetGuidedHobData (
- HobStart,
- &gMpInformationHobGuid,
- (VOID **) &MpInformationHobData
- );
- if (EFI_ERROR (Status)) {
- DEBUG ((DEBUG_INFO, "MpInformationHob extraction failed - 0x%x\n", Status));
- return Status;
- }
- //
- // Allocate memory for the MP information and copy over the MP information
- // passed by Trusted Firmware. Use the number of processors passed in the HOB
- // to copy the processor information
- //
- MpInfoSize = sizeof (MP_INFORMATION_HOB_DATA) +
- (sizeof (EFI_PROCESSOR_INFORMATION) *
- MpInformationHobData->NumberOfProcessors);
- Status = mMmst->MmAllocatePool (
- EfiRuntimeServicesData,
- MpInfoSize,
- (VOID **) &mMpInformationHobData
- );
- if (EFI_ERROR (Status)) {
- DEBUG ((DEBUG_INFO, "mMpInformationHobData mem alloc failed - 0x%x\n", Status));
- return Status;
- }
- CopyMem (mMpInformationHobData, MpInformationHobData, MpInfoSize);
- // Print MP information
- DEBUG ((DEBUG_INFO, "mMpInformationHobData: 0x%016lx - 0x%lx\n",
- mMpInformationHobData->NumberOfProcessors,
- mMpInformationHobData->NumberOfEnabledProcessors));
- for (Index = 0; Index < mMpInformationHobData->NumberOfProcessors; Index++) {
- DEBUG ((DEBUG_INFO, "mMpInformationHobData[0x%lx]: %d, %d, %d\n",
- mMpInformationHobData->ProcessorInfoBuffer[Index].ProcessorId,
- mMpInformationHobData->ProcessorInfoBuffer[Index].Location.Package,
- mMpInformationHobData->ProcessorInfoBuffer[Index].Location.Core,
- mMpInformationHobData->ProcessorInfoBuffer[Index].Location.Thread));
- }
- //
- // Allocate memory for a table to hold pointers to a
- // EFI_MM_COMMUNICATE_HEADER for each CPU
- //
- ArraySize = sizeof (EFI_MM_COMMUNICATE_HEADER *) *
- mMpInformationHobData->NumberOfEnabledProcessors;
- Status = mMmst->MmAllocatePool (
- EfiRuntimeServicesData,
- ArraySize,
- (VOID **) &PerCpuGuidedEventContext
- );
- if (EFI_ERROR (Status)) {
- DEBUG ((DEBUG_INFO, "PerCpuGuidedEventContext mem alloc failed - 0x%x\n", Status));
- return Status;
- }
- return Status;
- }
|