diff options
| -rw-r--r-- | UefiCpuPkg/CpuDxe/CpuMp.c | 33 |
1 files changed, 32 insertions, 1 deletions
diff --git a/UefiCpuPkg/CpuDxe/CpuMp.c b/UefiCpuPkg/CpuDxe/CpuMp.c index 878cdf25d..1b449a7a8 100644 --- a/UefiCpuPkg/CpuDxe/CpuMp.c +++ b/UefiCpuPkg/CpuDxe/CpuMp.c @@ -1108,10 +1108,41 @@ ProcessorToIdleState ( IN VOID *Context2 OPTIONAL
)
{
- DEBUG ((DEBUG_INFO, "Ap apicid is %d\n", GetApicId ()));
+ UINTN ProcessorNumber;
+ CPU_DATA_BLOCK *CpuData;
+ EFI_AP_PROCEDURE Procedure;
+ VOID *ProcedureArgument;
+
+ WhoAmI (&mMpServicesTemplate, &ProcessorNumber);
+ CpuData = &mMpSystemData.CpuDatas[ProcessorNumber];
AsmApDoneWithCommonStack ();
+ while (TRUE) {
+ while (!AcquireSpinLockOrFail (&CpuData->CpuDataLock)) {
+ CpuPause ();
+ }
+
+ ProcedureArgument = CpuData->Parameter;
+ Procedure = CpuData->Procedure;
+ ReleaseSpinLock (&CpuData->CpuDataLock);
+
+ if (Procedure != NULL) {
+ Procedure (ProcedureArgument);
+
+ while (!AcquireSpinLockOrFail (&CpuData->CpuDataLock)) {
+ CpuPause ();
+ }
+
+ CpuData->Procedure = NULL;
+ ReleaseSpinLock (&CpuData->CpuDataLock);
+
+ SetApState (CpuData, CpuStateFinished);
+ }
+
+ CpuPause ();
+ }
+
CpuSleep ();
CpuDeadLoop ();
}
|