/** @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
+ Copyright (c) 2008 - 2016, 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
#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
+EFI_HANDLE mMpServiceHandle = NULL;\r
+UINTN mNumberOfProcessors = 1;\r
\r
EFI_MP_SERVICES_PROTOCOL mMpServicesTemplate = {\r
GetNumberOfProcessors,\r
WhoAmI\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
- while (!AcquireSpinLockOrFail (&CpuData->CpuDataLock)) {\r
- CpuPause ();\r
- }\r
-\r
- State = CpuData->State;\r
- ReleaseSpinLock (&CpuData->CpuDataLock);\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
- while (!AcquireSpinLockOrFail (&CpuData->CpuDataLock)) {\r
- CpuPause ();\r
- }\r
-\r
- CpuData->State = State;\r
- ReleaseSpinLock (&CpuData->CpuDataLock);\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
- while (!AcquireSpinLockOrFail (&CpuData->CpuDataLock)) {\r
- CpuPause ();\r
- }\r
-\r
- CpuData->Parameter = ProcedureArgument;\r
- CpuData->Procedure = Procedure;\r
- ReleaseSpinLock (&CpuData->CpuDataLock);\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
- while (!AcquireSpinLockOrFail (&CpuData->CpuDataLock)) {\r
- CpuPause ();\r
- }\r
-\r
- Ret = CpuData->Info.StatusFlag & Flags;\r
- ReleaseSpinLock (&CpuData->CpuDataLock);\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
- while (!AcquireSpinLockOrFail (&CpuData->CpuDataLock)) {\r
- CpuPause ();\r
- }\r
-\r
- CpuData->Info.StatusFlag |= Flags;\r
- ReleaseSpinLock (&CpuData->CpuDataLock);\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
- while (!AcquireSpinLockOrFail (&CpuData->CpuDataLock)) {\r
- CpuPause ();\r
- }\r
-\r
- CpuData->Info.StatusFlag &= ~Flags;\r
- ReleaseSpinLock (&CpuData->CpuDataLock);\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
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
- 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
- if (WaitEvent != NULL) {\r
- Status = gBS->SetTimer (\r
- mMpSystemData.CheckAllAPsEvent,\r
- TimerPeriodic,\r
- EFI_TIMER_PERIOD_MICROSECONDS (100)\r
- );\r
- return Status;\r
- }\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
OUT BOOLEAN *Finished OPTIONAL\r
)\r
{\r
- CPU_DATA_BLOCK *CpuData;\r
- EFI_STATUS Status;\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
- 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
- if (WaitEvent != NULL) {\r
- //\r
- // Non Blocking\r
- //\r
- Status = gBS->SetTimer (\r
- CpuData->CheckThisAPEvent,\r
- TimerPeriodic,\r
- EFI_TIMER_PERIOD_MICROSECONDS (100)\r
- );\r
- return Status;\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
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
IN UINT32 *HealthFlag OPTIONAL\r
)\r
{\r
- CPU_DATA_BLOCK *CpuData;\r
-\r
- if (!IsBSP ()) {\r
- return EFI_DEVICE_ERROR;\r
- }\r
-\r
- if (ProcessorNumber >= mMpSystemData.NumberOfProcessors) {\r
- return EFI_NOT_FOUND;\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
- return EFI_SUCCESS;\r
+ return MpInitLibEnableDisableAP (ProcessorNumber, EnableAP, HealthFlag);\r
}\r
\r
/**\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
-}\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
-\r
- @param CpuData the pointer to CPU_DATA_BLOCK of specified AP\r
-\r
-**/\r
-VOID\r
-ResetProcessorToIdleState (\r
- IN CPU_DATA_BLOCK *CpuData\r
- )\r
-{\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
- )\r
-{\r
- DEBUG ((DEBUG_INFO, "Ap apicid is %d\n", GetApicId ()));\r
-\r
- AsmApDoneWithCommonStack ();\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
- }\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
- }\r
- ResetProcessorToIdleState (CpuData);\r
- goto out;\r
- }\r
-\r
- return;\r
-\r
-out:\r
- gBS->SetTimer (CpuData->CheckThisAPEvent, TimerCancel, 0);\r
- if (CpuData->WaitEvent) {\r
- gBS->SignalEvent (CpuData->WaitEvent);\r
- CpuData->WaitEvent = NULL;\r
- }\r
+ return MpInitLibWhoAmI (ProcessorNumber);;\r
}\r
\r
/**\r
- Checks APs' status periodically.\r
-\r
- This function is triggerred by timer perodically to check the\r
- state of APs for StartupAllAPs() executed in non-blocking mode.\r
+ Collects BIST data from HOB.\r
\r
- @param Event Event triggered.\r
- @param Context Parameter passed with the event.\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
-EFIAPI\r
-CheckAllAPsStatus (\r
- IN EFI_EVENT Event,\r
- IN VOID *Context\r
+CollectBistDataFromHob (\r
+ VOID\r
)\r
{\r
- if (mMpSystemData.TimeoutActive) {\r
- mMpSystemData.Timeout -= gPollInterval;\r
- }\r
-\r
- CheckAndUpdateAllAPsToIdleState ();\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
+\r
+ SecPlatformInformation2 = NULL;\r
+ SecPlatformInformation = NULL;\r
\r
//\r
- // task timeout\r
+ // Get gEfiSecPlatformInformation2PpiGuid Guided HOB firstly\r
//\r
- if (mMpSystemData.TimeoutActive && mMpSystemData.Timeout < 0) {\r
- ResetAllFailedAPs();\r
+ GuidHob = GetFirstGuidHob (&gEfiSecPlatformInformation2PpiGuid);\r
+ if (GuidHob != NULL) {\r
//\r
- // force exit\r
+ // Sec Platform Information2 PPI includes BSP/APs' BIST information\r
//\r
- mMpSystemData.FinishCount = mMpSystemData.StartCount;\r
- }\r
-\r
- if (mMpSystemData.FinishCount != mMpSystemData.StartCount) {\r
- return;\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 ((EFI_D_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
\r
- gBS->SetTimer (\r
- mMpSystemData.CheckAllAPsEvent,\r
- TimerCancel,\r
- 0\r
- );\r
-\r
- if (mMpSystemData.WaitEvent) {\r
- gBS->SignalEvent (mMpSystemData.WaitEvent);\r
- mMpSystemData.WaitEvent = NULL;\r
+ while ((NumberOfData--) > 0) {\r
+ for (ProcessorNumber = 0; ProcessorNumber < mNumberOfProcessors; ProcessorNumber++) {\r
+ MpInitLibGetProcessorInfo (ProcessorNumber, &ProcessorInfo, &BistData);\r
+ if (ProcessorInfo.ProcessorId == CpuInstance[NumberOfData].CpuLocation) {\r
+ //\r
+ // Update CPU health status for MP Services Protocol according to BIST data.\r
+ //\r
+ BistData = CpuInstance[NumberOfData].InfoRecord.IA32HealthFlags;\r
+ }\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
+ }\r
}\r
}\r
\r
/**\r
- Application Processor C code entry point.\r
+ Initialize Multi-processor support.\r
\r
**/\r
VOID\r
-EFIAPI\r
-ApEntryPointInC (\r
- VOID\r
- )\r
-{\r
- VOID* TopOfApStack;\r
-\r
- FillInProcessorInformation (FALSE, mMpSystemData.NumberOfProcessors);\r
- TopOfApStack = (UINT8*)mApStackStart + gApStackSize;\r
- mApStackStart = TopOfApStack;\r
-\r
- mMpSystemData.NumberOfProcessors++;\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
-\r
- @param Bsp TRUE if the CPU is BSP\r
- @param ProcessorNumber The specific processor number\r
-\r
- @retval EFI_SUCCESS Data for the processor collected and filled in\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
- }\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
-\r
- return EFI_SUCCESS;\r
-}\r
-\r
-/**\r
- Prepare the System Data.\r
-\r
- @retval EFI_SUCCESS the System Data finished initilization.\r
-\r
-**/\r
-EFI_STATUS\r
-InitMpSystemData (\r
+InitializeMpSupport (\r
VOID\r
)\r
{\r
- UINTN ProcessorNumber;\r
- CPU_DATA_BLOCK *CpuData;\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
- for (ProcessorNumber = 0; ProcessorNumber < gMaxLogicalProcessorNumber; ProcessorNumber++) {\r
- CpuData = &mMpSystemData.CpuDatas[ProcessorNumber];\r
- Status = gBS->CreateEvent (\r
- EVT_TIMER | EVT_NOTIFY_SIGNAL,\r
- TPL_CALLBACK,\r
- CheckThisAPStatus,\r
- (VOID *) CpuData,\r
- &CpuData->CheckThisAPEvent\r
- );\r
- ASSERT_EFI_ERROR (Status);\r
- }\r
+ UINTN NumberOfProcessors;\r
+ UINTN NumberOfEnabledProcessors;\r
\r
//\r
- // BSP\r
+ // Wakeup APs to do initialization\r
//\r
- FillInProcessorInformation (TRUE, 0);\r
-\r
- return EFI_SUCCESS;\r
-}\r
-\r
-/**\r
- Initialize Multi-processor support.\r
-\r
-**/\r
-VOID\r
-InitializeMpSupport (\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
+ Status = MpInitLibInitialize ();\r
+ ASSERT_EFI_ERROR (Status);\r
\r
- mApStackStart = AllocatePages (EFI_SIZE_TO_PAGES (gMaxLogicalProcessorNumber * gApStackSize));\r
- ASSERT (mApStackStart != NULL);\r
+ MpInitLibGetNumberOfProcessors (&NumberOfProcessors, &NumberOfEnabledProcessors);\r
+ mNumberOfProcessors = NumberOfProcessors;\r
+ DEBUG ((EFI_D_ERROR, "Detect CPU count: %d\n", mNumberOfProcessors));\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
+ // Update CPU healthy information from Guided HOB\r
//\r
- mCommonStack = mApStackStart;\r
- mTopOfApCommonStack = (UINT8*) mApStackStart + gApStackSize;\r
- mApStackStart = mTopOfApCommonStack;\r
-\r
- InitMpSystemData ();\r
+ CollectBistDataFromHob ();\r
\r
- if (mMpSystemData.NumberOfProcessors == 1) {\r
- FreePages (mCommonStack, EFI_SIZE_TO_PAGES (gMaxLogicalProcessorNumber * gApStackSize));\r
- return;\r
- }\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, &mMpServicesTemplate,\r
+ NULL\r
+ );\r
+ ASSERT_EFI_ERROR (Status);\r
}\r
+\r
projects / mirror_edk2.git / blobdiff