/** @file\r
- CPU DXE Module.\r
+ CPU DXE Module to produce CPU MP Protocol.\r
\r
- Copyright (c) 2008 - 2014, Intel Corporation. All rights reserved.<BR>\r
- This program and the accompanying materials\r
- are licensed and made available under the terms and conditions of the BSD License\r
- which accompanies this distribution. The full text of the license may be found at\r
- http://opensource.org/licenses/bsd-license.php\r
-\r
- THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
- WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
+ Copyright (c) 2008 - 2022, Intel Corporation. All rights reserved.<BR>\r
+ SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include "CpuDxe.h"\r
#include "CpuMp.h"\r
\r
-UINTN gMaxLogicalProcessorNumber;\r
-UINTN gApStackSize;\r
-UINTN gPollInterval = 100; // 100 microseconds\r
-\r
-MP_SYSTEM_DATA mMpSystemData;\r
-\r
-VOID *mCommonStack = 0;\r
-VOID *mTopOfApCommonStack = 0;\r
-VOID *mApStackStart = 0;\r
-\r
-volatile BOOLEAN mAPsAlreadyInitFinished = FALSE;\r
-volatile BOOLEAN mStopCheckAllAPsStatus = TRUE;\r
+EFI_HANDLE mMpServiceHandle = NULL;\r
+UINTN mNumberOfProcessors = 1;\r
\r
EFI_MP_SERVICES_PROTOCOL mMpServicesTemplate = {\r
GetNumberOfProcessors,\r
WhoAmI\r
};\r
\r
-/**\r
- Get Mp Service Lock.\r
-\r
- @param CpuData the pointer to CPU_DATA_BLOCK of specified processor\r
-\r
-**/\r
-VOID\r
-GetMpSpinLock (\r
- IN CPU_DATA_BLOCK *CpuData\r
- )\r
-{\r
- while (!AcquireSpinLockOrFail (&CpuData->CpuDataLock)) {\r
- CpuPause ();\r
- }\r
- CpuData->LockSelf = GetApicId ();\r
-}\r
-\r
-/**\r
- Release Mp Service Lock.\r
-\r
- @param CpuData the pointer to CPU_DATA_BLOCK of specified processor\r
-\r
-**/\r
-VOID\r
-ReleaseMpSpinLock (\r
- IN CPU_DATA_BLOCK *CpuData\r
- )\r
-{\r
- ReleaseSpinLock (&CpuData->CpuDataLock);\r
-}\r
-\r
-/**\r
- Check whether caller processor is BSP.\r
-\r
- @retval TRUE the caller is BSP\r
- @retval FALSE the caller is AP\r
-\r
-**/\r
-BOOLEAN\r
-IsBSP (\r
- VOID\r
- )\r
-{\r
- UINTN CpuIndex;\r
- CPU_DATA_BLOCK *CpuData;\r
-\r
- CpuData = NULL;\r
-\r
- WhoAmI (&mMpServicesTemplate, &CpuIndex);\r
- CpuData = &mMpSystemData.CpuDatas[CpuIndex];\r
-\r
- return CpuData->Info.StatusFlag & PROCESSOR_AS_BSP_BIT ? TRUE : FALSE;\r
-}\r
-\r
-/**\r
- Get the Application Processors state.\r
-\r
- @param CpuData the pointer to CPU_DATA_BLOCK of specified AP\r
-\r
- @retval CPU_STATE the AP status\r
-\r
-**/\r
-CPU_STATE\r
-GetApState (\r
- IN CPU_DATA_BLOCK *CpuData\r
- )\r
-{\r
- CPU_STATE State;\r
-\r
- GetMpSpinLock (CpuData);\r
- State = CpuData->State;\r
- ReleaseMpSpinLock (CpuData);\r
-\r
- return State;\r
-}\r
-\r
-/**\r
- Set the Application Processors state.\r
-\r
- @param CpuData The pointer to CPU_DATA_BLOCK of specified AP\r
- @param State The AP status\r
-\r
-**/\r
-VOID\r
-SetApState (\r
- IN CPU_DATA_BLOCK *CpuData,\r
- IN CPU_STATE State\r
- )\r
-{\r
- GetMpSpinLock (CpuData);\r
- CpuData->State = State;\r
- ReleaseMpSpinLock (CpuData);\r
-}\r
-\r
-/**\r
- Set the Application Processor prepare to run a function specified\r
- by Params.\r
-\r
- @param CpuData the pointer to CPU_DATA_BLOCK of specified AP\r
- @param Procedure A pointer to the function to be run on enabled APs of the system\r
- @param ProcedureArgument Pointer to the optional parameter of the assigned function\r
-\r
-**/\r
-VOID\r
-SetApProcedure (\r
- IN CPU_DATA_BLOCK *CpuData,\r
- IN EFI_AP_PROCEDURE Procedure,\r
- IN VOID *ProcedureArgument\r
- )\r
-{\r
- GetMpSpinLock (CpuData);\r
- CpuData->Parameter = ProcedureArgument;\r
- CpuData->Procedure = Procedure;\r
- ReleaseMpSpinLock (CpuData);\r
-}\r
-\r
-/**\r
- Check the Application Processors Status whether contains the Flags.\r
-\r
- @param CpuData the pointer to CPU_DATA_BLOCK of specified AP\r
- @param Flags the StatusFlag describing in EFI_PROCESSOR_INFORMATION\r
-\r
- @retval TRUE the AP status includes the StatusFlag\r
- @retval FALSE the AP status excludes the StatusFlag\r
-\r
-**/\r
-BOOLEAN\r
-TestCpuStatusFlag (\r
- IN CPU_DATA_BLOCK *CpuData,\r
- IN UINT32 Flags\r
- )\r
-{\r
- UINT32 Ret;\r
-\r
- GetMpSpinLock (CpuData);\r
- Ret = CpuData->Info.StatusFlag & Flags;\r
- ReleaseMpSpinLock (CpuData);\r
-\r
- return !!(Ret);\r
-}\r
-\r
-/**\r
- Bitwise-Or of the Application Processors Status with the Flags.\r
-\r
- @param CpuData the pointer to CPU_DATA_BLOCK of specified AP\r
- @param Flags the StatusFlag describing in EFI_PROCESSOR_INFORMATION\r
-\r
-**/\r
-VOID\r
-CpuStatusFlagOr (\r
- IN CPU_DATA_BLOCK *CpuData,\r
- IN UINT32 Flags\r
- )\r
-{\r
- GetMpSpinLock (CpuData);\r
- CpuData->Info.StatusFlag |= Flags;\r
- ReleaseMpSpinLock (CpuData);\r
-}\r
-\r
-/**\r
- Bitwise-AndNot of the Application Processors Status with the Flags.\r
-\r
- @param CpuData the pointer to CPU_DATA_BLOCK of specified AP\r
- @param Flags the StatusFlag describing in EFI_PROCESSOR_INFORMATION\r
-\r
-**/\r
-VOID\r
-CpuStatusFlagAndNot (\r
- IN CPU_DATA_BLOCK *CpuData,\r
- IN UINT32 Flags\r
- )\r
-{\r
- GetMpSpinLock (CpuData);\r
- CpuData->Info.StatusFlag &= ~Flags;\r
- ReleaseMpSpinLock (CpuData);\r
-}\r
-\r
-/**\r
- Searches for the next blocking AP.\r
-\r
- Search for the next AP that is put in blocking state by single-threaded StartupAllAPs().\r
-\r
- @param NextNumber Pointer to the processor number of the next blocking AP.\r
-\r
- @retval EFI_SUCCESS The next blocking AP has been found.\r
- @retval EFI_NOT_FOUND No blocking AP exists.\r
-\r
-**/\r
-EFI_STATUS\r
-GetNextBlockedNumber (\r
- OUT UINTN *NextNumber\r
- )\r
-{\r
- UINTN Number;\r
- CPU_STATE CpuState;\r
- CPU_DATA_BLOCK *CpuData;\r
-\r
- for (Number = 0; Number < mMpSystemData.NumberOfProcessors; Number++) {\r
- CpuData = &mMpSystemData.CpuDatas[Number];\r
- if (TestCpuStatusFlag (CpuData, PROCESSOR_AS_BSP_BIT)) {\r
- //\r
- // Skip BSP\r
- //\r
- continue;\r
- }\r
-\r
- CpuState = GetApState (CpuData);\r
- if (CpuState == CpuStateBlocked) {\r
- *NextNumber = Number;\r
- return EFI_SUCCESS;\r
- }\r
- }\r
-\r
- return EFI_NOT_FOUND;\r
-}\r
-\r
-/**\r
- Check if the APs state are finished, and update them to idle state\r
- by StartupAllAPs().\r
-\r
-**/\r
-VOID\r
-CheckAndUpdateAllAPsToIdleState (\r
- VOID\r
- )\r
-{\r
- UINTN ProcessorNumber;\r
- UINTN NextNumber;\r
- CPU_DATA_BLOCK *CpuData;\r
- EFI_STATUS Status;\r
- CPU_STATE CpuState;\r
-\r
- for (ProcessorNumber = 0; ProcessorNumber < mMpSystemData.NumberOfProcessors; ProcessorNumber++) {\r
- CpuData = &mMpSystemData.CpuDatas[ProcessorNumber];\r
- if (TestCpuStatusFlag (CpuData, PROCESSOR_AS_BSP_BIT)) {\r
- //\r
- // Skip BSP\r
- //\r
- continue;\r
- }\r
-\r
- if (!TestCpuStatusFlag (CpuData, PROCESSOR_ENABLED_BIT)) {\r
- //\r
- // Skip Disabled processors\r
- //\r
- continue;\r
- }\r
-\r
- CpuState = GetApState (CpuData);\r
- if (CpuState == CpuStateFinished) {\r
- mMpSystemData.FinishCount++;\r
- if (mMpSystemData.SingleThread) {\r
- Status = GetNextBlockedNumber (&NextNumber);\r
- if (!EFI_ERROR (Status)) {\r
- SetApState (&mMpSystemData.CpuDatas[NextNumber], CpuStateReady);\r
- SetApProcedure (&mMpSystemData.CpuDatas[NextNumber],\r
- mMpSystemData.Procedure,\r
- mMpSystemData.ProcedureArgument);\r
- }\r
- }\r
-\r
- SetApState (CpuData, CpuStateIdle);\r
- }\r
- }\r
-}\r
-\r
-/**\r
- If the timeout expires before all APs returns from Procedure,\r
- we should forcibly terminate the executing AP and fill FailedList back\r
- by StartupAllAPs().\r
-\r
-**/\r
-VOID\r
-ResetAllFailedAPs (\r
- VOID\r
- )\r
-{\r
- CPU_DATA_BLOCK *CpuData;\r
- UINTN Number;\r
- CPU_STATE CpuState;\r
-\r
- if (mMpSystemData.FailedList != NULL) {\r
- *mMpSystemData.FailedList = AllocatePool ((mMpSystemData.StartCount - mMpSystemData.FinishCount + 1) * sizeof(UINTN));\r
- ASSERT (*mMpSystemData.FailedList != NULL);\r
- }\r
-\r
- for (Number = 0; Number < mMpSystemData.NumberOfProcessors; Number++) {\r
- CpuData = &mMpSystemData.CpuDatas[Number];\r
- if (TestCpuStatusFlag (CpuData, PROCESSOR_AS_BSP_BIT)) {\r
- //\r
- // Skip BSP\r
- //\r
- continue;\r
- }\r
-\r
- if (!TestCpuStatusFlag (CpuData, PROCESSOR_ENABLED_BIT)) {\r
- //\r
- // Skip Disabled processors\r
- //\r
- continue;\r
- }\r
-\r
- CpuState = GetApState (CpuData);\r
- if (CpuState != CpuStateIdle) {\r
- if (mMpSystemData.FailedList != NULL) {\r
- (*mMpSystemData.FailedList)[mMpSystemData.FailedListIndex++] = Number;\r
- }\r
- ResetProcessorToIdleState (CpuData);\r
- }\r
- }\r
-\r
- if (mMpSystemData.FailedList != NULL) {\r
- (*mMpSystemData.FailedList)[mMpSystemData.FailedListIndex] = END_OF_CPU_LIST;\r
- }\r
-}\r
-\r
/**\r
This service retrieves the number of logical processor in the platform\r
and the number of those logical processors that are enabled on this boot.\r
return EFI_INVALID_PARAMETER;\r
}\r
\r
- if (!IsBSP ()) {\r
- return EFI_DEVICE_ERROR;\r
- }\r
-\r
- *NumberOfProcessors = mMpSystemData.NumberOfProcessors;\r
- *NumberOfEnabledProcessors = mMpSystemData.NumberOfEnabledProcessors;\r
- return EFI_SUCCESS;\r
+ return MpInitLibGetNumberOfProcessors (\r
+ NumberOfProcessors,\r
+ NumberOfEnabledProcessors\r
+ );\r
}\r
\r
/**\r
OUT EFI_PROCESSOR_INFORMATION *ProcessorInfoBuffer\r
)\r
{\r
- if (ProcessorInfoBuffer == NULL) {\r
- return EFI_INVALID_PARAMETER;\r
- }\r
-\r
- if (!IsBSP ()) {\r
- return EFI_DEVICE_ERROR;\r
- }\r
-\r
- if (ProcessorNumber >= mMpSystemData.NumberOfProcessors) {\r
- return EFI_NOT_FOUND;\r
- }\r
-\r
- CopyMem (ProcessorInfoBuffer, &mMpSystemData.CpuDatas[ProcessorNumber], sizeof (EFI_PROCESSOR_INFORMATION));\r
- return EFI_SUCCESS;\r
+ return MpInitLibGetProcessorInfo (ProcessorNumber, ProcessorInfoBuffer, NULL);\r
}\r
\r
/**\r
and releases the BSP to continue with other tasks.\r
-# The caller can use the CheckEvent() and WaitForEvent() services to check\r
the state of the WaitEvent created in step 1.\r
- -# When the APs complete their task or TimeoutInMicroSecondss expires, the MP\r
+ -# When the APs complete their task or TimeoutInMicroSeconds expires, the MP\r
Service signals WaitEvent by calling the EFI SignalEvent() function. If\r
FailedCpuList is not NULL, its content is available when WaitEvent is\r
signaled. If all APs returned from Procedure prior to the timeout, then\r
OUT UINTN **FailedCpuList OPTIONAL\r
)\r
{\r
- EFI_STATUS Status;\r
- CPU_DATA_BLOCK *CpuData;\r
- UINTN Number;\r
- CPU_STATE APInitialState;\r
-\r
- CpuData = NULL;\r
-\r
- if (FailedCpuList != NULL) {\r
- *FailedCpuList = NULL;\r
- }\r
-\r
- if (!IsBSP ()) {\r
- return EFI_DEVICE_ERROR;\r
- }\r
-\r
- if (mMpSystemData.NumberOfProcessors == 1) {\r
- return EFI_NOT_STARTED;\r
- }\r
-\r
- if (Procedure == NULL) {\r
- return EFI_INVALID_PARAMETER;\r
- }\r
-\r
- //\r
- // temporarily stop checkAllAPsStatus for avoid resource dead-lock.\r
- //\r
- mStopCheckAllAPsStatus = TRUE;\r
-\r
- for (Number = 0; Number < mMpSystemData.NumberOfProcessors; Number++) {\r
- CpuData = &mMpSystemData.CpuDatas[Number];\r
- if (TestCpuStatusFlag (CpuData, PROCESSOR_AS_BSP_BIT)) {\r
- //\r
- // Skip BSP\r
- //\r
- continue;\r
- }\r
-\r
- if (!TestCpuStatusFlag (CpuData, PROCESSOR_ENABLED_BIT)) {\r
- //\r
- // Skip Disabled processors\r
- //\r
- continue;\r
- }\r
-\r
- if (GetApState (CpuData) != CpuStateIdle) {\r
- return EFI_NOT_READY;\r
- }\r
- }\r
-\r
- mMpSystemData.Procedure = Procedure;\r
- mMpSystemData.ProcedureArgument = ProcedureArgument;\r
- mMpSystemData.WaitEvent = WaitEvent;\r
- mMpSystemData.Timeout = TimeoutInMicroseconds;\r
- mMpSystemData.TimeoutActive = !!(TimeoutInMicroseconds);\r
- mMpSystemData.FinishCount = 0;\r
- mMpSystemData.StartCount = 0;\r
- mMpSystemData.SingleThread = SingleThread;\r
- mMpSystemData.FailedList = FailedCpuList;\r
- mMpSystemData.FailedListIndex = 0;\r
- APInitialState = CpuStateReady;\r
-\r
- for (Number = 0; Number < mMpSystemData.NumberOfProcessors; Number++) {\r
- CpuData = &mMpSystemData.CpuDatas[Number];\r
- if (TestCpuStatusFlag (CpuData, PROCESSOR_AS_BSP_BIT)) {\r
- //\r
- // Skip BSP\r
- //\r
- continue;\r
- }\r
-\r
- if (!TestCpuStatusFlag (CpuData, PROCESSOR_ENABLED_BIT)) {\r
- //\r
- // Skip Disabled processors\r
- //\r
- continue;\r
- }\r
-\r
- //\r
- // Get APs prepared, and put failing APs into FailedCpuList\r
- // if "SingleThread", only 1 AP will put to ready state, other AP will be put to ready\r
- // state 1 by 1, until the previous 1 finished its task\r
- // if not "SingleThread", all APs are put to ready state from the beginning\r
- //\r
- if (GetApState (CpuData) == CpuStateIdle) {\r
- mMpSystemData.StartCount++;\r
-\r
- SetApState (CpuData, APInitialState);\r
-\r
- if (APInitialState == CpuStateReady) {\r
- SetApProcedure (CpuData, Procedure, ProcedureArgument);\r
- }\r
-\r
- if (SingleThread) {\r
- APInitialState = CpuStateBlocked;\r
- }\r
- }\r
- }\r
-\r
- mStopCheckAllAPsStatus = FALSE;\r
-\r
- if (WaitEvent != NULL) {\r
- //\r
- // non blocking\r
- //\r
- return EFI_SUCCESS;\r
- }\r
-\r
- //\r
- // Blocking temporarily stop CheckAllAPsStatus()\r
- //\r
- mStopCheckAllAPsStatus = TRUE;\r
-\r
- while (TRUE) {\r
- CheckAndUpdateAllAPsToIdleState ();\r
- if (mMpSystemData.FinishCount == mMpSystemData.StartCount) {\r
- Status = EFI_SUCCESS;\r
- goto Done;\r
- }\r
-\r
- //\r
- // task timeout\r
- //\r
- if (mMpSystemData.TimeoutActive && mMpSystemData.Timeout < 0) {\r
- ResetAllFailedAPs();\r
- Status = EFI_TIMEOUT;\r
- goto Done;\r
- }\r
-\r
- gBS->Stall (gPollInterval);\r
- mMpSystemData.Timeout -= gPollInterval;\r
- }\r
-\r
-Done:\r
-\r
- return Status;\r
+ return MpInitLibStartupAllAPs (\r
+ Procedure,\r
+ SingleThread,\r
+ WaitEvent,\r
+ TimeoutInMicroseconds,\r
+ ProcedureArgument,\r
+ FailedCpuList\r
+ );\r
}\r
\r
/**\r
This function is used to dispatch one enabled AP to the function specified by\r
Procedure passing in the argument specified by ProcedureArgument. If WaitEvent\r
is NULL, execution is in blocking mode. The BSP waits until the AP finishes or\r
- TimeoutInMicroSecondss expires. Otherwise, execution is in non-blocking mode.\r
+ TimeoutInMicroSeconds expires. Otherwise, execution is in non-blocking mode.\r
BSP proceeds to the next task without waiting for the AP. If a non-blocking mode\r
is requested after the UEFI Event EFI_EVENT_GROUP_READY_TO_BOOT is signaled,\r
then EFI_UNSUPPORTED must be returned.\r
\r
@param[in] This A pointer to the EFI_MP_SERVICES_PROTOCOL\r
instance.\r
- @param[in] Procedure A pointer to the function to be run on\r
- enabled APs of the system. See type\r
+ @param[in] Procedure A pointer to the function to be run on the\r
+ designated AP of the system. See type\r
EFI_AP_PROCEDURE.\r
@param[in] ProcessorNumber The handle number of the AP. The range is\r
from 0 to the total number of logical\r
EFI_MP_SERVICES_PROTOCOL.GetNumberOfProcessors().\r
@param[in] WaitEvent The event created by the caller with CreateEvent()\r
service. If it is NULL, then execute in\r
- blocking mode. BSP waits until all APs finish\r
- or TimeoutInMicroseconds expires. If it's\r
+ blocking mode. BSP waits until this AP finish\r
+ or TimeoutInMicroSeconds expires. If it's\r
not NULL, then execute in non-blocking mode.\r
BSP requests the function specified by\r
- Procedure to be started on all the enabled\r
- APs, and go on executing immediately. If\r
- all return from Procedure or TimeoutInMicroseconds\r
+ Procedure to be started on this AP,\r
+ and go on executing immediately. If this AP\r
+ return from Procedure or TimeoutInMicroSeconds\r
expires, this event is signaled. The BSP\r
can use the CheckEvent() or WaitForEvent()\r
services to check the state of event. Type\r
the Unified Extensible Firmware Interface\r
Specification.\r
@param[in] TimeoutInMicroseconds Indicates the time limit in microseconds for\r
- APs to return from Procedure, either for\r
+ this AP to finish this Procedure, either for\r
blocking or non-blocking mode. Zero means\r
infinity. If the timeout expires before\r
- all APs return from Procedure, then Procedure\r
- on the failed APs is terminated. All enabled\r
- APs are available for next function assigned\r
+ this AP returns from Procedure, then Procedure\r
+ on the AP is terminated. The\r
+ AP is available for next function assigned\r
by EFI_MP_SERVICES_PROTOCOL.StartupAllAPs()\r
or EFI_MP_SERVICES_PROTOCOL.StartupThisAP().\r
If the timeout expires in blocking mode,\r
BSP returns EFI_TIMEOUT. If the timeout\r
expires in non-blocking mode, WaitEvent\r
is signaled with SignalEvent().\r
- @param[in] ProcedureArgument The parameter passed into Procedure for\r
- all APs.\r
+ @param[in] ProcedureArgument The parameter passed into Procedure on the\r
+ specified AP.\r
@param[out] Finished If NULL, this parameter is ignored. In\r
blocking mode, this parameter is ignored.\r
In non-blocking mode, if AP returns from\r
OUT BOOLEAN *Finished OPTIONAL\r
)\r
{\r
- CPU_DATA_BLOCK *CpuData;\r
-\r
- CpuData = NULL;\r
-\r
- if (Finished != NULL) {\r
- *Finished = FALSE;\r
- }\r
-\r
- if (!IsBSP ()) {\r
- return EFI_DEVICE_ERROR;\r
- }\r
-\r
- if (Procedure == NULL) {\r
- return EFI_INVALID_PARAMETER;\r
- }\r
-\r
- if (ProcessorNumber >= mMpSystemData.NumberOfProcessors) {\r
- return EFI_NOT_FOUND;\r
- }\r
-\r
- //\r
- // temporarily stop checkAllAPsStatus for avoid resource dead-lock.\r
- //\r
- mStopCheckAllAPsStatus = TRUE;\r
-\r
- CpuData = &mMpSystemData.CpuDatas[ProcessorNumber];\r
- if (TestCpuStatusFlag (CpuData, PROCESSOR_AS_BSP_BIT) ||\r
- !TestCpuStatusFlag (CpuData, PROCESSOR_ENABLED_BIT)) {\r
- return EFI_INVALID_PARAMETER;\r
- }\r
-\r
- if (GetApState (CpuData) != CpuStateIdle) {\r
- return EFI_NOT_READY;\r
- }\r
-\r
- SetApState (CpuData, CpuStateReady);\r
-\r
- SetApProcedure (CpuData, Procedure, ProcedureArgument);\r
-\r
- CpuData->Timeout = TimeoutInMicroseconds;\r
- CpuData->WaitEvent = WaitEvent;\r
- CpuData->TimeoutActive = !!(TimeoutInMicroseconds);\r
- CpuData->Finished = Finished;\r
-\r
- mStopCheckAllAPsStatus = FALSE;\r
-\r
- if (WaitEvent != NULL) {\r
- //\r
- // Non Blocking\r
- //\r
- return EFI_SUCCESS;\r
- }\r
-\r
- //\r
- // Blocking\r
- //\r
- while (TRUE) {\r
- if (GetApState (CpuData) == CpuStateFinished) {\r
- SetApState (CpuData, CpuStateIdle);\r
- break;\r
- }\r
-\r
- if (CpuData->TimeoutActive && CpuData->Timeout < 0) {\r
- ResetProcessorToIdleState (CpuData);\r
- return EFI_TIMEOUT;\r
- }\r
-\r
- gBS->Stall (gPollInterval);\r
- CpuData->Timeout -= gPollInterval;\r
- }\r
-\r
- return EFI_SUCCESS;\r
+ return MpInitLibStartupThisAP (\r
+ Procedure,\r
+ ProcessorNumber,\r
+ WaitEvent,\r
+ TimeoutInMicroseconds,\r
+ ProcedureArgument,\r
+ Finished\r
+ );\r
}\r
\r
/**\r
@retval EFI_UNSUPPORTED Switching the BSP cannot be completed prior to\r
this service returning.\r
@retval EFI_UNSUPPORTED Switching the BSP is not supported.\r
- @retval EFI_SUCCESS The calling processor is an AP.\r
+ @retval EFI_DEVICE_ERROR The calling processor is an AP.\r
@retval EFI_NOT_FOUND The processor with the handle specified by\r
ProcessorNumber does not exist.\r
@retval EFI_INVALID_PARAMETER ProcessorNumber specifies the current BSP or\r
IN BOOLEAN EnableOldBSP\r
)\r
{\r
- //\r
- // Current always return unsupported.\r
- //\r
- return EFI_UNSUPPORTED;\r
+ return MpInitLibSwitchBSP (ProcessorNumber, EnableOldBSP);\r
}\r
\r
/**\r
from this service, then EFI_UNSUPPORTED must be returned.\r
\r
@param[in] This A pointer to the EFI_MP_SERVICES_PROTOCOL instance.\r
- @param[in] ProcessorNumber The handle number of AP that is to become the new\r
- BSP. The range is from 0 to the total number of\r
+ @param[in] ProcessorNumber The handle number of AP.\r
+ The range is from 0 to the total number of\r
logical processors minus 1. The total number of\r
logical processors can be retrieved by\r
EFI_MP_SERVICES_PROTOCOL.GetNumberOfProcessors().\r
IN UINT32 *HealthFlag OPTIONAL\r
)\r
{\r
- CPU_DATA_BLOCK *CpuData;\r
- BOOLEAN TempStopCheckState;\r
-\r
- CpuData = NULL;\r
- TempStopCheckState = FALSE;\r
-\r
- if (!IsBSP ()) {\r
- return EFI_DEVICE_ERROR;\r
- }\r
-\r
- if (ProcessorNumber >= mMpSystemData.NumberOfProcessors) {\r
- return EFI_NOT_FOUND;\r
- }\r
-\r
- //\r
- // temporarily stop checkAllAPsStatus for initialize parameters.\r
- //\r
- if (!mStopCheckAllAPsStatus) {\r
- mStopCheckAllAPsStatus = TRUE;\r
- TempStopCheckState = TRUE;\r
- }\r
-\r
- CpuData = &mMpSystemData.CpuDatas[ProcessorNumber];\r
- if (TestCpuStatusFlag (CpuData, PROCESSOR_AS_BSP_BIT)) {\r
- return EFI_INVALID_PARAMETER;\r
- }\r
-\r
- if (GetApState (CpuData) != CpuStateIdle) {\r
- return EFI_UNSUPPORTED;\r
- }\r
-\r
- if (EnableAP) {\r
- if (!(TestCpuStatusFlag (CpuData, PROCESSOR_ENABLED_BIT))) {\r
- mMpSystemData.NumberOfEnabledProcessors++;\r
- }\r
- CpuStatusFlagOr (CpuData, PROCESSOR_ENABLED_BIT);\r
- } else {\r
- if (TestCpuStatusFlag (CpuData, PROCESSOR_ENABLED_BIT)) {\r
- mMpSystemData.NumberOfEnabledProcessors--;\r
- }\r
- CpuStatusFlagAndNot (CpuData, PROCESSOR_ENABLED_BIT);\r
- }\r
-\r
- if (HealthFlag != NULL) {\r
- CpuStatusFlagAndNot (CpuData, (UINT32)~PROCESSOR_HEALTH_STATUS_BIT);\r
- CpuStatusFlagOr (CpuData, (*HealthFlag & PROCESSOR_HEALTH_STATUS_BIT));\r
- }\r
-\r
- if (TempStopCheckState) {\r
- mStopCheckAllAPsStatus = FALSE;\r
- }\r
-\r
- return EFI_SUCCESS;\r
+ return MpInitLibEnableDisableAP (ProcessorNumber, EnableAP, HealthFlag);\r
}\r
\r
/**\r
ProcessorNumber, and EFI_SUCCESS is returned.\r
\r
@param[in] This A pointer to the EFI_MP_SERVICES_PROTOCOL instance.\r
- @param[out] ProcessorNumber The handle number of AP that is to become the new\r
- BSP. The range is from 0 to the total number of\r
+ @param[out] ProcessorNumber Pointer to the handle number of AP.\r
+ The range is from 0 to the total number of\r
logical processors minus 1. The total number of\r
logical processors can be retrieved by\r
EFI_MP_SERVICES_PROTOCOL.GetNumberOfProcessors().\r
OUT UINTN *ProcessorNumber\r
)\r
{\r
- UINTN Index;\r
- UINT32 ProcessorId;\r
-\r
- if (ProcessorNumber == NULL) {\r
- return EFI_INVALID_PARAMETER;\r
- }\r
-\r
- ProcessorId = GetApicId ();\r
- for (Index = 0; Index < mMpSystemData.NumberOfProcessors; Index++) {\r
- if (mMpSystemData.CpuDatas[Index].Info.ProcessorId == ProcessorId) {\r
- break;\r
- }\r
- }\r
-\r
- *ProcessorNumber = Index;\r
- return EFI_SUCCESS;\r
+ return MpInitLibWhoAmI (ProcessorNumber);\r
}\r
\r
/**\r
- Terminate AP's task and set it to idle state.\r
-\r
- This function terminates AP's task due to timeout by sending INIT-SIPI,\r
- and sends it to idle state.\r
+ Collects BIST data from HOB.\r
\r
- @param CpuData the pointer to CPU_DATA_BLOCK of specified AP\r
+ This function collects BIST data from HOB built from Sec Platform Information\r
+ PPI or SEC Platform Information2 PPI.\r
\r
**/\r
VOID\r
-ResetProcessorToIdleState (\r
- IN CPU_DATA_BLOCK *CpuData\r
- )\r
-{\r
- ResetApStackless ((UINT32)CpuData->Info.ProcessorId);\r
-}\r
-\r
-/**\r
- Application Processors do loop routine\r
- after switch to its own stack.\r
-\r
- @param Context1 A pointer to the context to pass into the function.\r
- @param Context2 A pointer to the context to pass into the function.\r
-\r
-**/\r
-VOID\r
-ProcessorToIdleState (\r
- IN VOID *Context1, OPTIONAL\r
- IN VOID *Context2 OPTIONAL\r
+CollectBistDataFromHob (\r
+ VOID\r
)\r
{\r
- UINTN ProcessorNumber;\r
- CPU_DATA_BLOCK *CpuData;\r
- EFI_AP_PROCEDURE Procedure;\r
- VOID *ProcedureArgument;\r
-\r
- AsmApDoneWithCommonStack ();\r
-\r
- while (!mAPsAlreadyInitFinished) {\r
- CpuPause ();\r
- }\r
-\r
- WhoAmI (&mMpServicesTemplate, &ProcessorNumber);\r
- CpuData = &mMpSystemData.CpuDatas[ProcessorNumber];\r
-\r
- //\r
- // Avoid forcibly reset AP caused the AP got lock not release.\r
- //\r
- if (CpuData->LockSelf == (INTN) GetApicId ()) {\r
- ReleaseSpinLock (&CpuData->CpuDataLock);\r
- }\r
+ EFI_HOB_GUID_TYPE *GuidHob;\r
+ EFI_SEC_PLATFORM_INFORMATION_RECORD2 *SecPlatformInformation2;\r
+ EFI_SEC_PLATFORM_INFORMATION_RECORD *SecPlatformInformation;\r
+ UINTN NumberOfData;\r
+ EFI_SEC_PLATFORM_INFORMATION_CPU *CpuInstance;\r
+ EFI_SEC_PLATFORM_INFORMATION_CPU BspCpuInstance;\r
+ UINTN ProcessorNumber;\r
+ EFI_PROCESSOR_INFORMATION ProcessorInfo;\r
+ EFI_HEALTH_FLAGS BistData;\r
+ UINTN CpuInstanceNumber;\r
+\r
+ SecPlatformInformation2 = NULL;\r
+ SecPlatformInformation = NULL;\r
\r
//\r
- // Avoid forcibly reset AP caused the AP State is not updated.\r
+ // Get gEfiSecPlatformInformation2PpiGuid Guided HOB firstly\r
//\r
- GetMpSpinLock (CpuData);\r
- CpuData->State = CpuStateIdle;\r
- CpuData->Procedure = NULL;\r
- ReleaseMpSpinLock (CpuData);\r
-\r
- while (TRUE) {\r
- GetMpSpinLock (CpuData);\r
- ProcedureArgument = CpuData->Parameter;\r
- Procedure = CpuData->Procedure;\r
- ReleaseMpSpinLock (CpuData);\r
-\r
- if (Procedure != NULL) {\r
- Procedure (ProcedureArgument);\r
-\r
- GetMpSpinLock (CpuData);\r
- CpuData->Procedure = NULL;\r
- CpuData->State = CpuStateFinished;\r
- ReleaseMpSpinLock (CpuData);\r
+ GuidHob = GetFirstGuidHob (&gEfiSecPlatformInformation2PpiGuid);\r
+ if (GuidHob != NULL) {\r
+ //\r
+ // Sec Platform Information2 PPI includes BSP/APs' BIST information\r
+ //\r
+ SecPlatformInformation2 = GET_GUID_HOB_DATA (GuidHob);\r
+ NumberOfData = SecPlatformInformation2->NumberOfCpus;\r
+ CpuInstance = SecPlatformInformation2->CpuInstance;\r
+ } else {\r
+ //\r
+ // Otherwise, get gEfiSecPlatformInformationPpiGuid Guided HOB\r
+ //\r
+ GuidHob = GetFirstGuidHob (&gEfiSecPlatformInformationPpiGuid);\r
+ if (GuidHob != NULL) {\r
+ SecPlatformInformation = GET_GUID_HOB_DATA (GuidHob);\r
+ NumberOfData = 1;\r
+ //\r
+ // SEC Platform Information only includes BSP's BIST information\r
+ // does not have BSP's APIC ID\r
+ //\r
+ BspCpuInstance.CpuLocation = GetApicId ();\r
+ BspCpuInstance.InfoRecord.IA32HealthFlags.Uint32 = SecPlatformInformation->IA32HealthFlags.Uint32;\r
+ CpuInstance = &BspCpuInstance;\r
+ } else {\r
+ DEBUG ((DEBUG_INFO, "Does not find any HOB stored CPU BIST information!\n"));\r
+ //\r
+ // Does not find any HOB stored BIST information\r
+ //\r
+ return;\r
}\r
-\r
- CpuPause ();\r
- }\r
-\r
- CpuSleep ();\r
- CpuDeadLoop ();\r
-}\r
-\r
-/**\r
- Checks AP' status periodically.\r
-\r
- This function is triggerred by timer perodically to check the\r
- state of AP forStartupThisAP() executed in non-blocking mode.\r
-\r
- @param Event Event triggered.\r
- @param Context Parameter passed with the event.\r
-\r
-**/\r
-VOID\r
-EFIAPI\r
-CheckThisAPStatus (\r
- IN EFI_EVENT Event,\r
- IN VOID *Context\r
- )\r
-{\r
- CPU_DATA_BLOCK *CpuData;\r
- CPU_STATE CpuState;\r
-\r
- CpuData = (CPU_DATA_BLOCK *) Context;\r
- if (CpuData->TimeoutActive) {\r
- CpuData->Timeout -= gPollInterval;\r
}\r
\r
- CpuState = GetApState (CpuData);\r
-\r
- if (CpuState == CpuStateFinished) {\r
- if (CpuData->Finished) {\r
- *CpuData->Finished = TRUE;\r
+ for (ProcessorNumber = 0; ProcessorNumber < mNumberOfProcessors; ProcessorNumber++) {\r
+ MpInitLibGetProcessorInfo (ProcessorNumber, &ProcessorInfo, &BistData);\r
+ for (CpuInstanceNumber = 0; CpuInstanceNumber < NumberOfData; CpuInstanceNumber++) {\r
+ if (ProcessorInfo.ProcessorId == CpuInstance[CpuInstanceNumber].CpuLocation) {\r
+ //\r
+ // Update CPU health status for MP Services Protocol according to BIST data.\r
+ //\r
+ BistData = CpuInstance[CpuInstanceNumber].InfoRecord.IA32HealthFlags;\r
+ }\r
}\r
- SetApState (CpuData, CpuStateIdle);\r
- goto out;\r
- }\r
\r
- if (CpuData->TimeoutActive && CpuData->Timeout < 0) {\r
- if (CpuState != CpuStateIdle &&\r
- CpuData->Finished) {\r
- *CpuData->Finished = FALSE;\r
+ if (BistData.Uint32 != 0) {\r
+ //\r
+ // Report Status Code that self test is failed\r
+ //\r
+ REPORT_STATUS_CODE (\r
+ EFI_ERROR_CODE | EFI_ERROR_MAJOR,\r
+ (EFI_COMPUTING_UNIT_HOST_PROCESSOR | EFI_CU_HP_EC_SELF_TEST)\r
+ );\r
}\r
- ResetProcessorToIdleState (CpuData);\r
- goto out;\r
}\r
-\r
- return;\r
-\r
-out:\r
- CpuData->TimeoutActive = FALSE;\r
- gBS->SignalEvent (CpuData->WaitEvent);\r
- CpuData->WaitEvent = NULL;\r
}\r
\r
+//\r
+// Structure for InitializeSeparateExceptionStacks\r
+//\r
+typedef struct {\r
+ VOID *Buffer;\r
+ UINTN BufferSize;\r
+ EFI_STATUS Status;\r
+} EXCEPTION_STACK_SWITCH_CONTEXT;\r
+\r
/**\r
- Checks APs' status periodically.\r
+ Initializes CPU exceptions handlers for the sake of stack switch requirement.\r
\r
- This function is triggerred by timer perodically to check the\r
- state of APs for StartupAllAPs() executed in non-blocking mode.\r
+ This function is a wrapper of InitializeSeparateExceptionStacks. It's mainly\r
+ for the sake of AP's init because of EFI_AP_PROCEDURE API requirement.\r
\r
- @param Event Event triggered.\r
- @param Context Parameter passed with the event.\r
+ @param[in,out] Buffer The pointer to private data buffer.\r
\r
**/\r
VOID\r
EFIAPI\r
-CheckAllAPsStatus (\r
- IN EFI_EVENT Event,\r
- IN VOID *Context\r
+InitializeExceptionStackSwitchHandlers (\r
+ IN OUT VOID *Buffer\r
)\r
{\r
- CPU_DATA_BLOCK *CpuData;\r
- UINTN Number;\r
- EFI_STATUS Status;\r
+ EXCEPTION_STACK_SWITCH_CONTEXT *SwitchStackData;\r
+ UINTN Index;\r
\r
- if (mMpSystemData.TimeoutActive) {\r
- mMpSystemData.Timeout -= gPollInterval;\r
- }\r
-\r
- if (mStopCheckAllAPsStatus) {\r
- return;\r
- }\r
+ MpInitLibWhoAmI (&Index);\r
+ SwitchStackData = (EXCEPTION_STACK_SWITCH_CONTEXT *)Buffer;\r
\r
//\r
- // avoid next timer enter.\r
+ // This may be called twice for each Cpu. Only run InitializeSeparateExceptionStacks\r
+ // if this is the first call or the first call failed because of size too small.\r
//\r
- Status = gBS->SetTimer (\r
- mMpSystemData.CheckAllAPsEvent,\r
- TimerCancel,\r
- 0\r
- );\r
- ASSERT_EFI_ERROR (Status);\r
-\r
- if (mMpSystemData.WaitEvent != NULL) {\r
- CheckAndUpdateAllAPsToIdleState ();\r
- //\r
- // task timeout\r
- //\r
- if (mMpSystemData.TimeoutActive && mMpSystemData.Timeout < 0) {\r
- ResetAllFailedAPs();\r
- //\r
- // force exit\r
- //\r
- mMpSystemData.FinishCount = mMpSystemData.StartCount;\r
- }\r
-\r
- if (mMpSystemData.FinishCount != mMpSystemData.StartCount) {\r
- goto EXIT;\r
- }\r
-\r
- mMpSystemData.TimeoutActive = FALSE;\r
- gBS->SignalEvent (mMpSystemData.WaitEvent);\r
- mMpSystemData.WaitEvent = NULL;\r
- mStopCheckAllAPsStatus = TRUE;\r
-\r
- goto EXIT;\r
+ if ((SwitchStackData[Index].Status == EFI_NOT_STARTED) || (SwitchStackData[Index].Status == EFI_BUFFER_TOO_SMALL)) {\r
+ SwitchStackData[Index].Status = InitializeSeparateExceptionStacks (SwitchStackData[Index].Buffer, &SwitchStackData[Index].BufferSize);\r
}\r
-\r
- //\r
- // check each AP status for StartupThisAP\r
- //\r
- for (Number = 0; Number < mMpSystemData.NumberOfProcessors; Number++) {\r
- CpuData = &mMpSystemData.CpuDatas[Number];\r
- if (CpuData->WaitEvent) {\r
- CheckThisAPStatus (NULL, (VOID *)CpuData);\r
- }\r
- }\r
-\r
-EXIT:\r
- Status = gBS->SetTimer (\r
- mMpSystemData.CheckAllAPsEvent,\r
- TimerPeriodic,\r
- EFI_TIMER_PERIOD_MICROSECONDS (100)\r
- );\r
- ASSERT_EFI_ERROR (Status);\r
}\r
\r
/**\r
- Application Processor C code entry point.\r
+ Initializes MP exceptions handlers for the sake of stack switch requirement.\r
+\r
+ This function will allocate required resources required to setup stack switch\r
+ and pass them through SwitchStackData to each logic processor.\r
\r
**/\r
VOID\r
-EFIAPI\r
-ApEntryPointInC (\r
+InitializeMpExceptionStackSwitchHandlers (\r
VOID\r
)\r
{\r
- VOID* TopOfApStack;\r
- UINTN ProcessorNumber;\r
-\r
- if (!mAPsAlreadyInitFinished) {\r
- FillInProcessorInformation (FALSE, mMpSystemData.NumberOfProcessors);\r
- TopOfApStack = (UINT8*)mApStackStart + gApStackSize;\r
- mApStackStart = TopOfApStack;\r
-\r
- //\r
- // Store the Stack address, when reset the AP, We can found the original address.\r
- //\r
- mMpSystemData.CpuDatas[mMpSystemData.NumberOfProcessors].TopOfStack = TopOfApStack;\r
- mMpSystemData.NumberOfProcessors++;\r
- mMpSystemData.NumberOfEnabledProcessors++;\r
- } else {\r
- WhoAmI (&mMpServicesTemplate, &ProcessorNumber);\r
+ UINTN Index;\r
+ EXCEPTION_STACK_SWITCH_CONTEXT *SwitchStackData;\r
+ UINTN BufferSize;\r
+ EFI_STATUS Status;\r
+ UINT8 *Buffer;\r
+\r
+ SwitchStackData = AllocateZeroPool (mNumberOfProcessors * sizeof (EXCEPTION_STACK_SWITCH_CONTEXT));\r
+ ASSERT (SwitchStackData != NULL);\r
+ for (Index = 0; Index < mNumberOfProcessors; ++Index) {\r
//\r
- // Get the original stack address.\r
+ // Because the procedure may runs multiple times, use the status EFI_NOT_STARTED\r
+ // to indicate the procedure haven't been run yet.\r
//\r
- TopOfApStack = mMpSystemData.CpuDatas[ProcessorNumber].TopOfStack;\r
+ SwitchStackData[Index].Status = EFI_NOT_STARTED;\r
}\r
\r
- SwitchStack (\r
- (SWITCH_STACK_ENTRY_POINT)(UINTN)ProcessorToIdleState,\r
- NULL,\r
- NULL,\r
- TopOfApStack);\r
-}\r
-\r
-/**\r
- This function is called by all processors (both BSP and AP) once and collects MP related data.\r
+ Status = MpInitLibStartupAllCPUs (\r
+ InitializeExceptionStackSwitchHandlers,\r
+ 0,\r
+ SwitchStackData\r
+ );\r
+ ASSERT_EFI_ERROR (Status);\r
\r
- @param Bsp TRUE if the CPU is BSP\r
- @param ProcessorNumber The specific processor number\r
+ BufferSize = 0;\r
+ for (Index = 0; Index < mNumberOfProcessors; ++Index) {\r
+ if (SwitchStackData[Index].Status == EFI_BUFFER_TOO_SMALL) {\r
+ ASSERT (SwitchStackData[Index].BufferSize != 0);\r
+ BufferSize += SwitchStackData[Index].BufferSize;\r
+ } else {\r
+ ASSERT (SwitchStackData[Index].Status == EFI_SUCCESS);\r
+ ASSERT (SwitchStackData[Index].BufferSize == 0);\r
+ }\r
+ }\r
\r
- @retval EFI_SUCCESS Data for the processor collected and filled in\r
+ if (BufferSize != 0) {\r
+ Buffer = AllocateRuntimeZeroPool (BufferSize);\r
+ ASSERT (Buffer != NULL);\r
+ BufferSize = 0;\r
+ for (Index = 0; Index < mNumberOfProcessors; ++Index) {\r
+ if (SwitchStackData[Index].Status == EFI_BUFFER_TOO_SMALL) {\r
+ SwitchStackData[Index].Buffer = (VOID *)(&Buffer[BufferSize]);\r
+ BufferSize += SwitchStackData[Index].BufferSize;\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "Buffer[cpu%lu] for InitializeExceptionStackSwitchHandlers: 0x%lX with size 0x%lX\n",\r
+ (UINT64)(UINTN)Index,\r
+ (UINT64)(UINTN)SwitchStackData[Index].Buffer,\r
+ (UINT64)(UINTN)SwitchStackData[Index].BufferSize\r
+ ));\r
+ }\r
+ }\r
\r
-**/\r
-EFI_STATUS\r
-FillInProcessorInformation (\r
- IN BOOLEAN Bsp,\r
- IN UINTN ProcessorNumber\r
- )\r
-{\r
- CPU_DATA_BLOCK *CpuData;\r
- UINT32 ProcessorId;\r
-\r
- CpuData = &mMpSystemData.CpuDatas[ProcessorNumber];\r
- ProcessorId = GetApicId ();\r
- CpuData->Info.ProcessorId = ProcessorId;\r
- CpuData->Info.StatusFlag = PROCESSOR_ENABLED_BIT | PROCESSOR_HEALTH_STATUS_BIT;\r
- if (Bsp) {\r
- CpuData->Info.StatusFlag |= PROCESSOR_AS_BSP_BIT;\r
+ Status = MpInitLibStartupAllCPUs (\r
+ InitializeExceptionStackSwitchHandlers,\r
+ 0,\r
+ SwitchStackData\r
+ );\r
+ ASSERT_EFI_ERROR (Status);\r
+ for (Index = 0; Index < mNumberOfProcessors; ++Index) {\r
+ ASSERT (SwitchStackData[Index].Status == EFI_SUCCESS);\r
+ }\r
}\r
- CpuData->Info.Location.Package = ProcessorId;\r
- CpuData->Info.Location.Core = 0;\r
- CpuData->Info.Location.Thread = 0;\r
- CpuData->State = Bsp ? CpuStateBuzy : CpuStateIdle;\r
-\r
- CpuData->Procedure = NULL;\r
- CpuData->Parameter = NULL;\r
- InitializeSpinLock (&CpuData->CpuDataLock);\r
- CpuData->LockSelf = -1;\r
\r
- return EFI_SUCCESS;\r
+ FreePool (SwitchStackData);\r
}\r
\r
/**\r
- Prepare the System Data.\r
-\r
- @retval EFI_SUCCESS the System Data finished initilization.\r
-\r
+ Initializes MP exceptions handlers for special features, such as Heap Guard\r
+ and Stack Guard.\r
**/\r
-EFI_STATUS\r
-InitMpSystemData (\r
+VOID\r
+InitializeMpExceptionHandlers (\r
VOID\r
)\r
{\r
- EFI_STATUS Status;\r
-\r
- ZeroMem (&mMpSystemData, sizeof (MP_SYSTEM_DATA));\r
-\r
- mMpSystemData.NumberOfProcessors = 1;\r
- mMpSystemData.NumberOfEnabledProcessors = 1;\r
-\r
- mMpSystemData.CpuDatas = AllocateZeroPool (sizeof (CPU_DATA_BLOCK) * gMaxLogicalProcessorNumber);\r
- ASSERT(mMpSystemData.CpuDatas != NULL);\r
-\r
- Status = gBS->CreateEvent (\r
- EVT_TIMER | EVT_NOTIFY_SIGNAL,\r
- TPL_CALLBACK,\r
- CheckAllAPsStatus,\r
- NULL,\r
- &mMpSystemData.CheckAllAPsEvent\r
- );\r
- ASSERT_EFI_ERROR (Status);\r
-\r
//\r
- // Set timer to check all APs status.\r
+ // Enable non-stop mode for #PF triggered by Heap Guard or NULL Pointer\r
+ // Detection.\r
//\r
- Status = gBS->SetTimer (\r
- mMpSystemData.CheckAllAPsEvent,\r
- TimerPeriodic,\r
- EFI_TIMER_PERIOD_MICROSECONDS (100)\r
- );\r
- ASSERT_EFI_ERROR (Status);\r
+ if (HEAP_GUARD_NONSTOP_MODE || NULL_DETECTION_NONSTOP_MODE) {\r
+ RegisterCpuInterruptHandler (EXCEPT_IA32_DEBUG, DebugExceptionHandler);\r
+ RegisterCpuInterruptHandler (EXCEPT_IA32_PAGE_FAULT, PageFaultExceptionHandler);\r
+ }\r
\r
//\r
- // BSP\r
+ // Setup stack switch for Stack Guard feature.\r
//\r
- FillInProcessorInformation (TRUE, 0);\r
-\r
- return EFI_SUCCESS;\r
+ if (PcdGetBool (PcdCpuStackGuard)) {\r
+ InitializeMpExceptionStackSwitchHandlers ();\r
+ }\r
}\r
\r
/**\r
VOID\r
)\r
{\r
- gMaxLogicalProcessorNumber = (UINTN) PcdGet32 (PcdCpuMaxLogicalProcessorNumber);\r
- if (gMaxLogicalProcessorNumber < 1) {\r
- DEBUG ((DEBUG_ERROR, "Setting PcdCpuMaxLogicalProcessorNumber should be more than zero.\n"));\r
- return;\r
- }\r
-\r
- if (gMaxLogicalProcessorNumber == 1) {\r
- return;\r
- }\r
-\r
- gApStackSize = (UINTN) PcdGet32 (PcdCpuApStackSize);\r
- ASSERT ((gApStackSize & (SIZE_4KB - 1)) == 0);\r
-\r
- mApStackStart = AllocatePages (EFI_SIZE_TO_PAGES (gMaxLogicalProcessorNumber * gApStackSize));\r
- ASSERT (mApStackStart != NULL);\r
+ EFI_STATUS Status;\r
+ UINTN NumberOfProcessors;\r
+ UINTN NumberOfEnabledProcessors;\r
\r
//\r
- // the first buffer of stack size used for common stack, when the amount of AP\r
- // more than 1, we should never free the common stack which maybe used for AP reset.\r
+ // Wakeup APs to do initialization\r
//\r
- mCommonStack = mApStackStart;\r
- mTopOfApCommonStack = (UINT8*) mApStackStart + gApStackSize;\r
- mApStackStart = mTopOfApCommonStack;\r
-\r
- InitMpSystemData ();\r
-\r
- PrepareAPStartupCode ();\r
-\r
- StartApsStackless ();\r
+ Status = MpInitLibInitialize ();\r
+ ASSERT_EFI_ERROR (Status);\r
\r
- DEBUG ((DEBUG_INFO, "Detect CPU count: %d\n", mMpSystemData.NumberOfProcessors));\r
- if (mMpSystemData.NumberOfProcessors == 1) {\r
- FreeApStartupCode ();\r
- FreePages (mCommonStack, EFI_SIZE_TO_PAGES (gMaxLogicalProcessorNumber * gApStackSize));\r
- return;\r
- }\r
+ MpInitLibGetNumberOfProcessors (&NumberOfProcessors, &NumberOfEnabledProcessors);\r
+ mNumberOfProcessors = NumberOfProcessors;\r
+ DEBUG ((DEBUG_INFO, "Detect CPU count: %d\n", mNumberOfProcessors));\r
\r
- mMpSystemData.CpuDatas = ReallocatePool (\r
- sizeof (CPU_DATA_BLOCK) * gMaxLogicalProcessorNumber,\r
- sizeof (CPU_DATA_BLOCK) * mMpSystemData.NumberOfProcessors,\r
- mMpSystemData.CpuDatas);\r
+ //\r
+ // Initialize special exception handlers for each logic processor.\r
+ //\r
+ InitializeMpExceptionHandlers ();\r
\r
- mAPsAlreadyInitFinished = TRUE;\r
+ //\r
+ // Update CPU healthy information from Guided HOB\r
+ //\r
+ CollectBistDataFromHob ();\r
\r
- if (mMpSystemData.NumberOfProcessors < gMaxLogicalProcessorNumber) {\r
- FreePages (mApStackStart, EFI_SIZE_TO_PAGES (\r
- (gMaxLogicalProcessorNumber - mMpSystemData.NumberOfProcessors) *\r
- gApStackSize));\r
- }\r
+ Status = gBS->InstallMultipleProtocolInterfaces (\r
+ &mMpServiceHandle,\r
+ &gEfiMpServiceProtocolGuid,\r
+ &mMpServicesTemplate,\r
+ NULL\r
+ );\r
+ ASSERT_EFI_ERROR (Status);\r
}\r
projects / mirror_edk2.git / blobdiff