]> git.proxmox.com Git - mirror_edk2.git/blobdiff - UefiCpuPkg/Library/MpInitLib/MpLib.c
UefiCpuPkg: Apply uncrustify changes
[mirror_edk2.git] / UefiCpuPkg / Library / MpInitLib / MpLib.c
index b9a06747edbf1ba504def3fed7febe656bfa7be1..2d8e9512ab98e261f8b6956aee3c98f76b6e7de8 100644 (file)
@@ -13,8 +13,7 @@
 #include <Register/Amd/Fam17Msr.h>\r
 #include <Register/Amd/Ghcb.h>\r
 \r
-EFI_GUID mCpuInitMpLibHobGuid = CPU_INIT_MP_LIB_HOB_GUID;\r
-\r
+EFI_GUID  mCpuInitMpLibHobGuid = CPU_INIT_MP_LIB_HOB_GUID;\r
 \r
 /**\r
   The function will check if BSP Execute Disable is enabled.\r
@@ -38,7 +37,7 @@ IsBspExecuteDisableEnabled (
   BOOLEAN                     Enabled;\r
   IA32_CR0                    Cr0;\r
 \r
-  Enabled = FALSE;\r
+  Enabled   = FALSE;\r
   Cr0.UintN = AsmReadCr0 ();\r
   if (Cr0.Bits.PG != 0) {\r
     //\r
@@ -78,12 +77,12 @@ IsBspExecuteDisableEnabled (
 VOID\r
 EFIAPI\r
 FutureBSPProc (\r
-  IN  VOID            *Buffer\r
+  IN  VOID  *Buffer\r
   )\r
 {\r
-  CPU_MP_DATA         *DataInHob;\r
+  CPU_MP_DATA  *DataInHob;\r
 \r
-  DataInHob = (CPU_MP_DATA *) Buffer;\r
+  DataInHob = (CPU_MP_DATA *)Buffer;\r
   AsmExchangeRole (&DataInHob->APInfo, &DataInHob->BSPInfo);\r
 }\r
 \r
@@ -96,7 +95,7 @@ FutureBSPProc (
 **/\r
 CPU_STATE\r
 GetApState (\r
-  IN  CPU_AP_DATA     *CpuData\r
+  IN  CPU_AP_DATA  *CpuData\r
   )\r
 {\r
   return CpuData->State;\r
@@ -110,8 +109,8 @@ GetApState (
 **/\r
 VOID\r
 SetApState (\r
-  IN  CPU_AP_DATA     *CpuData,\r
-  IN  CPU_STATE       State\r
+  IN  CPU_AP_DATA  *CpuData,\r
+  IN  CPU_STATE    State\r
   )\r
 {\r
   AcquireSpinLock (&CpuData->ApLock);\r
@@ -126,7 +125,7 @@ SetApState (
 **/\r
 VOID\r
 SaveLocalApicTimerSetting (\r
-  IN CPU_MP_DATA   *CpuMpData\r
+  IN CPU_MP_DATA  *CpuMpData\r
   )\r
 {\r
   //\r
@@ -148,7 +147,7 @@ SaveLocalApicTimerSetting (
 **/\r
 VOID\r
 SyncLocalApicTimerSetting (\r
-  IN CPU_MP_DATA   *CpuMpData\r
+  IN CPU_MP_DATA  *CpuMpData\r
   )\r
 {\r
   //\r
@@ -173,10 +172,10 @@ SyncLocalApicTimerSetting (
 **/\r
 VOID\r
 SaveVolatileRegisters (\r
-  OUT CPU_VOLATILE_REGISTERS    *VolatileRegisters\r
+  OUT CPU_VOLATILE_REGISTERS  *VolatileRegisters\r
   )\r
 {\r
-  CPUID_VERSION_INFO_EDX        VersionInfoEdx;\r
+  CPUID_VERSION_INFO_EDX  VersionInfoEdx;\r
 \r
   VolatileRegisters->Cr0 = AsmReadCr0 ();\r
   VolatileRegisters->Cr3 = AsmReadCr3 ();\r
@@ -210,12 +209,12 @@ SaveVolatileRegisters (
 **/\r
 VOID\r
 RestoreVolatileRegisters (\r
-  IN CPU_VOLATILE_REGISTERS    *VolatileRegisters,\r
-  IN BOOLEAN                   IsRestoreDr\r
+  IN CPU_VOLATILE_REGISTERS  *VolatileRegisters,\r
+  IN BOOLEAN                 IsRestoreDr\r
   )\r
 {\r
-  CPUID_VERSION_INFO_EDX        VersionInfoEdx;\r
-  IA32_TSS_DESCRIPTOR           *Tss;\r
+  CPUID_VERSION_INFO_EDX  VersionInfoEdx;\r
+  IA32_TSS_DESCRIPTOR     *Tss;\r
 \r
   AsmWriteCr3 (VolatileRegisters->Cr3);\r
   AsmWriteCr4 (VolatileRegisters->Cr4);\r
@@ -239,8 +238,9 @@ RestoreVolatileRegisters (
 \r
   AsmWriteGdtr (&VolatileRegisters->Gdtr);\r
   AsmWriteIdtr (&VolatileRegisters->Idtr);\r
-  if (VolatileRegisters->Tr != 0 &&\r
-      VolatileRegisters->Tr < VolatileRegisters->Gdtr.Limit) {\r
+  if ((VolatileRegisters->Tr != 0) &&\r
+      (VolatileRegisters->Tr < VolatileRegisters->Gdtr.Limit))\r
+  {\r
     Tss = (IA32_TSS_DESCRIPTOR *)(VolatileRegisters->Gdtr.Base +\r
                                   VolatileRegisters->Tr);\r
     if (Tss->Bits.P == 1) {\r
@@ -261,7 +261,7 @@ IsMwaitSupport (
   VOID\r
   )\r
 {\r
-  CPUID_VERSION_INFO_ECX        VersionInfoEcx;\r
+  CPUID_VERSION_INFO_ECX  VersionInfoEcx;\r
 \r
   AsmCpuid (CPUID_VERSION_INFO, NULL, NULL, &VersionInfoEcx.Uint32, NULL);\r
   return (VersionInfoEcx.Bits.MONITOR == 1) ? TRUE : FALSE;\r
@@ -276,11 +276,11 @@ IsMwaitSupport (
 **/\r
 UINT8\r
 GetApLoopMode (\r
-  OUT UINT32     *MonitorFilterSize\r
+  OUT UINT32  *MonitorFilterSize\r
   )\r
 {\r
-  UINT8                         ApLoopMode;\r
-  CPUID_MONITOR_MWAIT_EBX       MonitorMwaitEbx;\r
+  UINT8                    ApLoopMode;\r
+  CPUID_MONITOR_MWAIT_EBX  MonitorMwaitEbx;\r
 \r
   ASSERT (MonitorFilterSize != NULL);\r
 \r
@@ -328,20 +328,20 @@ GetApLoopMode (
 **/\r
 VOID\r
 SortApicId (\r
-  IN CPU_MP_DATA   *CpuMpData\r
+  IN CPU_MP_DATA  *CpuMpData\r
   )\r
 {\r
-  UINTN             Index1;\r
-  UINTN             Index2;\r
-  UINTN             Index3;\r
-  UINT32            ApicId;\r
-  CPU_INFO_IN_HOB   CpuInfo;\r
-  UINT32            ApCount;\r
-  CPU_INFO_IN_HOB   *CpuInfoInHob;\r
-  volatile UINT32   *StartupApSignal;\r
-\r
-  ApCount = CpuMpData->CpuCount - 1;\r
-  CpuInfoInHob = (CPU_INFO_IN_HOB *) (UINTN) CpuMpData->CpuInfoInHob;\r
+  UINTN            Index1;\r
+  UINTN            Index2;\r
+  UINTN            Index3;\r
+  UINT32           ApicId;\r
+  CPU_INFO_IN_HOB  CpuInfo;\r
+  UINT32           ApCount;\r
+  CPU_INFO_IN_HOB  *CpuInfoInHob;\r
+  volatile UINT32  *StartupApSignal;\r
+\r
+  ApCount      = CpuMpData->CpuCount - 1;\r
+  CpuInfoInHob = (CPU_INFO_IN_HOB *)(UINTN)CpuMpData->CpuInfoInHob;\r
   if (ApCount != 0) {\r
     for (Index1 = 0; Index1 < ApCount; Index1++) {\r
       Index3 = Index1;\r
@@ -355,6 +355,7 @@ SortApicId (
           ApicId = CpuInfoInHob[Index2].ApicId;\r
         }\r
       }\r
+\r
       if (Index3 != Index1) {\r
         CopyMem (&CpuInfo, &CpuInfoInHob[Index3], sizeof (CPU_INFO_IN_HOB));\r
         CopyMem (\r
@@ -367,7 +368,7 @@ SortApicId (
         //\r
         // Also exchange the StartupApSignal.\r
         //\r
-        StartupApSignal = CpuMpData->CpuData[Index3].StartupApSignal;\r
+        StartupApSignal                            = CpuMpData->CpuData[Index3].StartupApSignal;\r
         CpuMpData->CpuData[Index3].StartupApSignal =\r
           CpuMpData->CpuData[Index1].StartupApSignal;\r
         CpuMpData->CpuData[Index1].StartupApSignal = StartupApSignal;\r
@@ -380,7 +381,7 @@ SortApicId (
     ApicId = GetInitialApicId ();\r
     for (Index1 = 0; Index1 < CpuMpData->CpuCount; Index1++) {\r
       if (CpuInfoInHob[Index1].ApicId == ApicId) {\r
-        CpuMpData->BspNumber = (UINT32) Index1;\r
+        CpuMpData->BspNumber = (UINT32)Index1;\r
         break;\r
       }\r
     }\r
@@ -416,8 +417,8 @@ ApInitializeSync (
   UINTN        ProcessorNumber;\r
   EFI_STATUS   Status;\r
 \r
-  CpuMpData = (CPU_MP_DATA *) Buffer;\r
-  Status = GetProcessorNumber (CpuMpData, &ProcessorNumber);\r
+  CpuMpData = (CPU_MP_DATA *)Buffer;\r
+  Status    = GetProcessorNumber (CpuMpData, &ProcessorNumber);\r
   ASSERT_EFI_ERROR (Status);\r
   //\r
   // Load microcode on AP\r
@@ -440,20 +441,20 @@ ApInitializeSync (
 **/\r
 EFI_STATUS\r
 GetProcessorNumber (\r
-  IN CPU_MP_DATA               *CpuMpData,\r
-  OUT UINTN                    *ProcessorNumber\r
+  IN CPU_MP_DATA  *CpuMpData,\r
+  OUT UINTN       *ProcessorNumber\r
   )\r
 {\r
-  UINTN                   TotalProcessorNumber;\r
-  UINTN                   Index;\r
-  CPU_INFO_IN_HOB         *CpuInfoInHob;\r
-  UINT32                  CurrentApicId;\r
+  UINTN            TotalProcessorNumber;\r
+  UINTN            Index;\r
+  CPU_INFO_IN_HOB  *CpuInfoInHob;\r
+  UINT32           CurrentApicId;\r
 \r
-  CpuInfoInHob = (CPU_INFO_IN_HOB *) (UINTN) CpuMpData->CpuInfoInHob;\r
+  CpuInfoInHob = (CPU_INFO_IN_HOB *)(UINTN)CpuMpData->CpuInfoInHob;\r
 \r
   TotalProcessorNumber = CpuMpData->CpuCount;\r
-  CurrentApicId = GetApicId ();\r
-  for (Index = 0; Index < TotalProcessorNumber; Index ++) {\r
+  CurrentApicId        = GetApicId ();\r
+  for (Index = 0; Index < TotalProcessorNumber; Index++) {\r
     if (CpuInfoInHob[Index].ApicId == CurrentApicId) {\r
       *ProcessorNumber = Index;\r
       return EFI_SUCCESS;\r
@@ -472,12 +473,12 @@ GetProcessorNumber (
 **/\r
 UINTN\r
 CollectProcessorCount (\r
-  IN CPU_MP_DATA         *CpuMpData\r
+  IN CPU_MP_DATA  *CpuMpData\r
   )\r
 {\r
-  UINTN                  Index;\r
-  CPU_INFO_IN_HOB        *CpuInfoInHob;\r
-  BOOLEAN                X2Apic;\r
+  UINTN            Index;\r
+  CPU_INFO_IN_HOB  *CpuInfoInHob;\r
+  BOOLEAN          X2Apic;\r
 \r
   //\r
   // Send 1st broadcast IPI to APs to wakeup APs\r
@@ -504,7 +505,7 @@ CollectProcessorCount (
     //\r
     X2Apic = TRUE;\r
   } else {\r
-    CpuInfoInHob = (CPU_INFO_IN_HOB *) (UINTN) CpuMpData->CpuInfoInHob;\r
+    CpuInfoInHob = (CPU_INFO_IN_HOB *)(UINTN)CpuMpData->CpuInfoInHob;\r
     for (Index = 0; Index < CpuMpData->CpuCount; Index++) {\r
       if (CpuInfoInHob[Index].InitialApicId >= 0xFF) {\r
         X2Apic = TRUE;\r
@@ -525,6 +526,7 @@ CollectProcessorCount (
     while (CpuMpData->FinishedCount < (CpuMpData->CpuCount - 1)) {\r
       CpuPause ();\r
     }\r
+\r
     //\r
     // Enable x2APIC on BSP\r
     //\r
@@ -536,6 +538,7 @@ CollectProcessorCount (
       SetApState (&CpuMpData->CpuData[Index], CpuStateIdle);\r
     }\r
   }\r
+\r
   DEBUG ((DEBUG_INFO, "APIC MODE is %d\n", GetApicMode ()));\r
   //\r
   // Sort BSP/Aps by CPU APIC ID in ascending order\r
@@ -558,16 +561,16 @@ CollectProcessorCount (
 **/\r
 VOID\r
 InitializeApData (\r
-  IN OUT CPU_MP_DATA      *CpuMpData,\r
-  IN     UINTN            ProcessorNumber,\r
-  IN     UINT32           BistData,\r
-  IN     UINT64           ApTopOfStack\r
+  IN OUT CPU_MP_DATA  *CpuMpData,\r
+  IN     UINTN        ProcessorNumber,\r
+  IN     UINT32       BistData,\r
+  IN     UINT64       ApTopOfStack\r
   )\r
 {\r
-  CPU_INFO_IN_HOB                  *CpuInfoInHob;\r
-  MSR_IA32_PLATFORM_ID_REGISTER    PlatformIdMsr;\r
+  CPU_INFO_IN_HOB                *CpuInfoInHob;\r
+  MSR_IA32_PLATFORM_ID_REGISTER  PlatformIdMsr;\r
 \r
-  CpuInfoInHob = (CPU_INFO_IN_HOB *) (UINTN) CpuMpData->CpuInfoInHob;\r
+  CpuInfoInHob                                = (CPU_INFO_IN_HOB *)(UINTN)CpuMpData->CpuInfoInHob;\r
   CpuInfoInHob[ProcessorNumber].InitialApicId = GetInitialApicId ();\r
   CpuInfoInHob[ProcessorNumber].ApicId        = GetApicId ();\r
   CpuInfoInHob[ProcessorNumber].Health        = BistData;\r
@@ -580,7 +583,7 @@ InitializeApData (
   // NOTE: PlatformId is not relevant on AMD platforms.\r
   //\r
   if (!StandardSignatureIsAuthenticAMD ()) {\r
-    PlatformIdMsr.Uint64 = AsmReadMsr64 (MSR_IA32_PLATFORM_ID);\r
+    PlatformIdMsr.Uint64                           = AsmReadMsr64 (MSR_IA32_PLATFORM_ID);\r
     CpuMpData->CpuData[ProcessorNumber].PlatformId = (UINT8)PlatformIdMsr.Bits.PlatformId;\r
   }\r
 \r
@@ -592,7 +595,7 @@ InitializeApData (
     NULL\r
     );\r
 \r
-  InitializeSpinLock(&CpuMpData->CpuData[ProcessorNumber].ApLock);\r
+  InitializeSpinLock (&CpuMpData->CpuData[ProcessorNumber].ApLock);\r
   SetApState (&CpuMpData->CpuData[ProcessorNumber], CpuStateIdle);\r
 }\r
 \r
@@ -613,18 +616,21 @@ GetProtectedMode16CS (
   UINTN                    GdtEntryCount;\r
   UINT16                   Index;\r
 \r
-  Index = (UINT16) -1;\r
+  Index = (UINT16)-1;\r
   AsmReadGdtr (&GdtrDesc);\r
   GdtEntryCount = (GdtrDesc.Limit + 1) / sizeof (IA32_SEGMENT_DESCRIPTOR);\r
-  GdtEntry = (IA32_SEGMENT_DESCRIPTOR *) GdtrDesc.Base;\r
+  GdtEntry      = (IA32_SEGMENT_DESCRIPTOR *)GdtrDesc.Base;\r
   for (Index = 0; Index < GdtEntryCount; Index++) {\r
-    if (GdtEntry->Bits.L == 0 &&\r
-        GdtEntry->Bits.DB == 0 &&\r
-        GdtEntry->Bits.Type > 8) {\r
+    if ((GdtEntry->Bits.L == 0) &&\r
+        (GdtEntry->Bits.DB == 0) &&\r
+        (GdtEntry->Bits.Type > 8))\r
+    {\r
       break;\r
     }\r
+\r
     GdtEntry++;\r
   }\r
+\r
   ASSERT (Index != GdtEntryCount);\r
   return Index * 8;\r
 }\r
@@ -646,18 +652,21 @@ GetProtectedMode32CS (
   UINTN                    GdtEntryCount;\r
   UINT16                   Index;\r
 \r
-  Index = (UINT16) -1;\r
+  Index = (UINT16)-1;\r
   AsmReadGdtr (&GdtrDesc);\r
   GdtEntryCount = (GdtrDesc.Limit + 1) / sizeof (IA32_SEGMENT_DESCRIPTOR);\r
-  GdtEntry = (IA32_SEGMENT_DESCRIPTOR *) GdtrDesc.Base;\r
+  GdtEntry      = (IA32_SEGMENT_DESCRIPTOR *)GdtrDesc.Base;\r
   for (Index = 0; Index < GdtEntryCount; Index++) {\r
-    if (GdtEntry->Bits.L == 0 &&\r
-        GdtEntry->Bits.DB == 1 &&\r
-        GdtEntry->Bits.Type > 8) {\r
+    if ((GdtEntry->Bits.L == 0) &&\r
+        (GdtEntry->Bits.DB == 1) &&\r
+        (GdtEntry->Bits.Type > 8))\r
+    {\r
       break;\r
     }\r
+\r
     GdtEntry++;\r
   }\r
+\r
   ASSERT (Index != GdtEntryCount);\r
   return Index * 8;\r
 }\r
@@ -674,16 +683,16 @@ GetProtectedMode32CS (
 STATIC\r
 VOID\r
 MpInitLibSevEsAPReset (\r
-  IN GHCB                         *Ghcb,\r
-  IN CPU_MP_DATA                  *CpuMpData\r
+  IN GHCB         *Ghcb,\r
+  IN CPU_MP_DATA  *CpuMpData\r
   )\r
 {\r
-  EFI_STATUS       Status;\r
-  UINTN            ProcessorNumber;\r
-  UINT16           Code16, Code32;\r
-  AP_RESET         *APResetFn;\r
-  UINTN            BufferStart;\r
-  UINTN            StackStart;\r
+  EFI_STATUS  Status;\r
+  UINTN       ProcessorNumber;\r
+  UINT16      Code16, Code32;\r
+  AP_RESET    *APResetFn;\r
+  UINTN       BufferStart;\r
+  UINTN       StackStart;\r
 \r
   Status = GetProcessorNumber (CpuMpData, &ProcessorNumber);\r
   ASSERT_EFI_ERROR (Status);\r
@@ -692,14 +701,14 @@ MpInitLibSevEsAPReset (
   Code32 = GetProtectedMode32CS ();\r
 \r
   if (CpuMpData->WakeupBufferHigh != 0) {\r
-    APResetFn = (AP_RESET *) (CpuMpData->WakeupBufferHigh + CpuMpData->AddressMap.SwitchToRealNoNxOffset);\r
+    APResetFn = (AP_RESET *)(CpuMpData->WakeupBufferHigh + CpuMpData->AddressMap.SwitchToRealNoNxOffset);\r
   } else {\r
-    APResetFn = (AP_RESET *) (CpuMpData->MpCpuExchangeInfo->BufferStart + CpuMpData->AddressMap.SwitchToRealOffset);\r
+    APResetFn = (AP_RESET *)(CpuMpData->MpCpuExchangeInfo->BufferStart + CpuMpData->AddressMap.SwitchToRealOffset);\r
   }\r
 \r
   BufferStart = CpuMpData->MpCpuExchangeInfo->BufferStart;\r
-  StackStart = CpuMpData->SevEsAPResetStackStart -\r
-                 (AP_RESET_STACK_SIZE * ProcessorNumber);\r
+  StackStart  = CpuMpData->SevEsAPResetStackStart -\r
+                (AP_RESET_STACK_SIZE * ProcessorNumber);\r
 \r
   //\r
   // This call never returns.\r
@@ -716,19 +725,19 @@ MpInitLibSevEsAPReset (
 VOID\r
 EFIAPI\r
 ApWakeupFunction (\r
-  IN MP_CPU_EXCHANGE_INFO      *ExchangeInfo,\r
-  IN UINTN                     ApIndex\r
+  IN MP_CPU_EXCHANGE_INFO  *ExchangeInfo,\r
+  IN UINTN                 ApIndex\r
   )\r
 {\r
-  CPU_MP_DATA                *CpuMpData;\r
-  UINTN                      ProcessorNumber;\r
-  EFI_AP_PROCEDURE           Procedure;\r
-  VOID                       *Parameter;\r
-  UINT32                     BistData;\r
-  volatile UINT32            *ApStartupSignalBuffer;\r
-  CPU_INFO_IN_HOB            *CpuInfoInHob;\r
-  UINT64                     ApTopOfStack;\r
-  UINTN                      CurrentApicMode;\r
+  CPU_MP_DATA       *CpuMpData;\r
+  UINTN             ProcessorNumber;\r
+  EFI_AP_PROCEDURE  Procedure;\r
+  VOID              *Parameter;\r
+  UINT32            BistData;\r
+  volatile UINT32   *ApStartupSignalBuffer;\r
+  CPU_INFO_IN_HOB   *CpuInfoInHob;\r
+  UINT64            ApTopOfStack;\r
+  UINTN             CurrentApicMode;\r
 \r
   //\r
   // AP finished assembly code and begin to execute C code\r
@@ -753,8 +762,8 @@ ApWakeupFunction (
       //\r
       // This is first time AP wakeup, get BIST information from AP stack\r
       //\r
-      ApTopOfStack  = CpuMpData->Buffer + (ProcessorNumber + 1) * CpuMpData->CpuApStackSize;\r
-      BistData = *(UINT32 *) ((UINTN) ApTopOfStack - sizeof (UINTN));\r
+      ApTopOfStack = CpuMpData->Buffer + (ProcessorNumber + 1) * CpuMpData->CpuApStackSize;\r
+      BistData     = *(UINT32 *)((UINTN)ApTopOfStack - sizeof (UINTN));\r
       //\r
       // CpuMpData->CpuData[0].VolatileRegisters is initialized based on BSP environment,\r
       //   to initialize AP in InitConfig path.\r
@@ -773,7 +782,7 @@ ApWakeupFunction (
       //\r
       ApStartupSignalBuffer = CpuMpData->CpuData[ProcessorNumber].StartupApSignal;\r
       InterlockedCompareExchange32 (\r
-        (UINT32 *) ApStartupSignalBuffer,\r
+        (UINT32 *)ApStartupSignalBuffer,\r
         WAKEUP_AP_SIGNAL,\r
         0\r
         );\r
@@ -788,7 +797,7 @@ ApWakeupFunction (
         //   different IDT shared by all APs.\r
         //\r
         RestoreVolatileRegisters (&CpuMpData->CpuData[0].VolatileRegisters, FALSE);\r
-      }  else {\r
+      } else {\r
         if (CpuMpData->ApLoopMode == ApInHltLoop) {\r
           //\r
           // Restore AP's volatile registers saved before AP is halted\r
@@ -806,7 +815,7 @@ ApWakeupFunction (
 \r
       if (GetApState (&CpuMpData->CpuData[ProcessorNumber]) == CpuStateReady) {\r
         Procedure = (EFI_AP_PROCEDURE)CpuMpData->CpuData[ProcessorNumber].ApFunction;\r
-        Parameter = (VOID *) CpuMpData->CpuData[ProcessorNumber].ApFunctionArgument;\r
+        Parameter = (VOID *)CpuMpData->CpuData[ProcessorNumber].ApFunctionArgument;\r
         if (Procedure != NULL) {\r
           SetApState (&CpuMpData->CpuData[ProcessorNumber], CpuStateBusy);\r
           //\r
@@ -817,19 +826,20 @@ ApWakeupFunction (
           // Invoke AP function here\r
           //\r
           Procedure (Parameter);\r
-          CpuInfoInHob = (CPU_INFO_IN_HOB *) (UINTN) CpuMpData->CpuInfoInHob;\r
+          CpuInfoInHob = (CPU_INFO_IN_HOB *)(UINTN)CpuMpData->CpuInfoInHob;\r
           if (CpuMpData->SwitchBspFlag) {\r
             //\r
             // Re-get the processor number due to BSP/AP maybe exchange in AP function\r
             //\r
             GetProcessorNumber (CpuMpData, &ProcessorNumber);\r
-            CpuMpData->CpuData[ProcessorNumber].ApFunction = 0;\r
+            CpuMpData->CpuData[ProcessorNumber].ApFunction         = 0;\r
             CpuMpData->CpuData[ProcessorNumber].ApFunctionArgument = 0;\r
-            ApStartupSignalBuffer = CpuMpData->CpuData[ProcessorNumber].StartupApSignal;\r
-            CpuInfoInHob[ProcessorNumber].ApTopOfStack = CpuInfoInHob[CpuMpData->NewBspNumber].ApTopOfStack;\r
+            ApStartupSignalBuffer                                  = CpuMpData->CpuData[ProcessorNumber].StartupApSignal;\r
+            CpuInfoInHob[ProcessorNumber].ApTopOfStack             = CpuInfoInHob[CpuMpData->NewBspNumber].ApTopOfStack;\r
           } else {\r
-            if (CpuInfoInHob[ProcessorNumber].ApicId != GetApicId () ||\r
-                CpuInfoInHob[ProcessorNumber].InitialApicId != GetInitialApicId ()) {\r
+            if ((CpuInfoInHob[ProcessorNumber].ApicId != GetApicId ()) ||\r
+                (CpuInfoInHob[ProcessorNumber].InitialApicId != GetInitialApicId ()))\r
+            {\r
               if (CurrentApicMode != GetApicMode ()) {\r
                 //\r
                 // If APIC mode change happened during AP function execution,\r
@@ -847,6 +857,7 @@ ApWakeupFunction (
             }\r
           }\r
         }\r
+\r
         SetApState (&CpuMpData->CpuData[ProcessorNumber], CpuStateFinished);\r
       }\r
     }\r
@@ -861,7 +872,7 @@ ApWakeupFunction (
     //\r
     // AP finished executing C code\r
     //\r
-    InterlockedIncrement ((UINT32 *) &CpuMpData->FinishedCount);\r
+    InterlockedIncrement ((UINT32 *)&CpuMpData->FinishedCount);\r
 \r
     if (CpuMpData->InitFlag == ApInitConfig) {\r
       //\r
@@ -870,7 +881,7 @@ ApWakeupFunction (
       // performs another INIT-SIPI-SIPI sequence.\r
       //\r
       if (!CpuMpData->SevEsIsEnabled) {\r
-        InterlockedDecrement ((UINT32 *) &CpuMpData->MpCpuExchangeInfo->NumApsExecuting);\r
+        InterlockedDecrement ((UINT32 *)&CpuMpData->MpCpuExchangeInfo->NumApsExecuting);\r
       }\r
     }\r
 \r
@@ -890,11 +901,11 @@ ApWakeupFunction (
           BOOLEAN                   DoDecrement;\r
           BOOLEAN                   InterruptState;\r
 \r
-          DoDecrement = (BOOLEAN) (CpuMpData->InitFlag == ApInitConfig);\r
+          DoDecrement = (BOOLEAN)(CpuMpData->InitFlag == ApInitConfig);\r
 \r
           while (TRUE) {\r
             Msr.GhcbPhysicalAddress = AsmReadMsr64 (MSR_SEV_ES_GHCB);\r
-            Ghcb = Msr.Ghcb;\r
+            Ghcb                    = Msr.Ghcb;\r
 \r
             VmgInit (Ghcb, &InterruptState);\r
 \r
@@ -905,7 +916,7 @@ ApWakeupFunction (
               // Perform the delayed decrement just before issuing the first\r
               // VMGEXIT with AP_RESET_HOLD.\r
               //\r
-              InterlockedDecrement ((UINT32 *) &CpuMpData->MpCpuExchangeInfo->NumApsExecuting);\r
+              InterlockedDecrement ((UINT32 *)&CpuMpData->MpCpuExchangeInfo->NumApsExecuting);\r
             }\r
 \r
             Status = VmgExit (Ghcb, SVM_EXIT_AP_RESET_HOLD, 0, 0);\r
@@ -928,16 +939,18 @@ ApWakeupFunction (
         } else {\r
           CpuSleep ();\r
         }\r
+\r
         CpuPause ();\r
       }\r
     }\r
+\r
     while (TRUE) {\r
       DisableInterrupts ();\r
       if (CpuMpData->ApLoopMode == ApInMwaitLoop) {\r
         //\r
         // Place AP in MWAIT-loop\r
         //\r
-        AsmMonitor ((UINTN) ApStartupSignalBuffer, 0, 0);\r
+        AsmMonitor ((UINTN)ApStartupSignalBuffer, 0, 0);\r
         if (*ApStartupSignalBuffer != WAKEUP_AP_SIGNAL) {\r
           //\r
           // Check AP start-up signal again.\r
@@ -973,7 +986,7 @@ ApWakeupFunction (
 **/\r
 VOID\r
 WaitApWakeup (\r
-  IN volatile UINT32        *ApStartupSignalBuffer\r
+  IN volatile UINT32  *ApStartupSignalBuffer\r
   )\r
 {\r
   //\r
@@ -981,10 +994,11 @@ WaitApWakeup (
   // Otherwise, write StartupApSignal again till AP waken up.\r
   //\r
   while (InterlockedCompareExchange32 (\r
-          (UINT32 *) ApStartupSignalBuffer,\r
-          WAKEUP_AP_SIGNAL,\r
-          WAKEUP_AP_SIGNAL\r
-          ) != 0) {\r
+           (UINT32 *)ApStartupSignalBuffer,\r
+           WAKEUP_AP_SIGNAL,\r
+           WAKEUP_AP_SIGNAL\r
+           ) != 0)\r
+  {\r
     CpuPause ();\r
   }\r
 }\r
@@ -997,30 +1011,30 @@ WaitApWakeup (
 **/\r
 VOID\r
 FillExchangeInfoData (\r
-  IN CPU_MP_DATA               *CpuMpData\r
+  IN CPU_MP_DATA  *CpuMpData\r
   )\r
 {\r
-  volatile MP_CPU_EXCHANGE_INFO    *ExchangeInfo;\r
-  UINTN                            Size;\r
-  IA32_SEGMENT_DESCRIPTOR          *Selector;\r
-  IA32_CR4                         Cr4;\r
+  volatile MP_CPU_EXCHANGE_INFO  *ExchangeInfo;\r
+  UINTN                          Size;\r
+  IA32_SEGMENT_DESCRIPTOR        *Selector;\r
+  IA32_CR4                       Cr4;\r
 \r
-  ExchangeInfo                  = CpuMpData->MpCpuExchangeInfo;\r
-  ExchangeInfo->StackStart      = CpuMpData->Buffer;\r
-  ExchangeInfo->StackSize       = CpuMpData->CpuApStackSize;\r
-  ExchangeInfo->BufferStart     = CpuMpData->WakeupBuffer;\r
-  ExchangeInfo->ModeOffset      = CpuMpData->AddressMap.ModeEntryOffset;\r
+  ExchangeInfo              = CpuMpData->MpCpuExchangeInfo;\r
+  ExchangeInfo->StackStart  = CpuMpData->Buffer;\r
+  ExchangeInfo->StackSize   = CpuMpData->CpuApStackSize;\r
+  ExchangeInfo->BufferStart = CpuMpData->WakeupBuffer;\r
+  ExchangeInfo->ModeOffset  = CpuMpData->AddressMap.ModeEntryOffset;\r
 \r
-  ExchangeInfo->CodeSegment     = AsmReadCs ();\r
-  ExchangeInfo->DataSegment     = AsmReadDs ();\r
+  ExchangeInfo->CodeSegment = AsmReadCs ();\r
+  ExchangeInfo->DataSegment = AsmReadDs ();\r
 \r
-  ExchangeInfo->Cr3             = AsmReadCr3 ();\r
+  ExchangeInfo->Cr3 = AsmReadCr3 ();\r
 \r
-  ExchangeInfo->CFunction       = (UINTN) ApWakeupFunction;\r
+  ExchangeInfo->CFunction       = (UINTN)ApWakeupFunction;\r
   ExchangeInfo->ApIndex         = 0;\r
   ExchangeInfo->NumApsExecuting = 0;\r
-  ExchangeInfo->InitFlag        = (UINTN) CpuMpData->InitFlag;\r
-  ExchangeInfo->CpuInfo         = (CPU_INFO_IN_HOB *) (UINTN) CpuMpData->CpuInfoInHob;\r
+  ExchangeInfo->InitFlag        = (UINTN)CpuMpData->InitFlag;\r
+  ExchangeInfo->CpuInfo         = (CPU_INFO_IN_HOB *)(UINTN)CpuMpData->CpuInfoInHob;\r
   ExchangeInfo->CpuMpData       = CpuMpData;\r
 \r
   ExchangeInfo->EnableExecuteDisable = IsBspExecuteDisableEnabled ();\r
@@ -1035,32 +1049,33 @@ FillExchangeInfoData (
   // Using latter way is simpler because it also eliminates the needs to\r
   //  check whether platform wants to enable it.\r
   //\r
-  Cr4.UintN = AsmReadCr4 ();\r
-  ExchangeInfo->Enable5LevelPaging = (BOOLEAN) (Cr4.Bits.LA57 == 1);\r
+  Cr4.UintN                        = AsmReadCr4 ();\r
+  ExchangeInfo->Enable5LevelPaging = (BOOLEAN)(Cr4.Bits.LA57 == 1);\r
   DEBUG ((DEBUG_INFO, "%a: 5-Level Paging = %d\n", gEfiCallerBaseName, ExchangeInfo->Enable5LevelPaging));\r
 \r
-  ExchangeInfo->SevEsIsEnabled  = CpuMpData->SevEsIsEnabled;\r
-  ExchangeInfo->GhcbBase        = (UINTN) CpuMpData->GhcbBase;\r
+  ExchangeInfo->SevEsIsEnabled = CpuMpData->SevEsIsEnabled;\r
+  ExchangeInfo->GhcbBase       = (UINTN)CpuMpData->GhcbBase;\r
 \r
   //\r
   // Get the BSP's data of GDT and IDT\r
   //\r
-  AsmReadGdtr ((IA32_DESCRIPTOR *) &ExchangeInfo->GdtrProfile);\r
-  AsmReadIdtr ((IA32_DESCRIPTOR *) &ExchangeInfo->IdtrProfile);\r
+  AsmReadGdtr ((IA32_DESCRIPTOR *)&ExchangeInfo->GdtrProfile);\r
+  AsmReadIdtr ((IA32_DESCRIPTOR *)&ExchangeInfo->IdtrProfile);\r
 \r
   //\r
   // Find a 32-bit code segment\r
   //\r
   Selector = (IA32_SEGMENT_DESCRIPTOR *)ExchangeInfo->GdtrProfile.Base;\r
-  Size = ExchangeInfo->GdtrProfile.Limit + 1;\r
+  Size     = ExchangeInfo->GdtrProfile.Limit + 1;\r
   while (Size > 0) {\r
-    if (Selector->Bits.L == 0 && Selector->Bits.Type >= 8) {\r
+    if ((Selector->Bits.L == 0) && (Selector->Bits.Type >= 8)) {\r
       ExchangeInfo->ModeTransitionSegment =\r
         (UINT16)((UINTN)Selector - ExchangeInfo->GdtrProfile.Base);\r
       break;\r
     }\r
+\r
     Selector += 1;\r
-    Size -= sizeof (IA32_SEGMENT_DESCRIPTOR);\r
+    Size     -= sizeof (IA32_SEGMENT_DESCRIPTOR);\r
   }\r
 \r
   //\r
@@ -1069,8 +1084,8 @@ FillExchangeInfoData (
   //\r
   if (CpuMpData->WakeupBufferHigh != 0) {\r
     Size = CpuMpData->AddressMap.RendezvousFunnelSize +\r
-             CpuMpData->AddressMap.SwitchToRealSize -\r
-             CpuMpData->AddressMap.ModeTransitionOffset;\r
+           CpuMpData->AddressMap.SwitchToRealSize -\r
+           CpuMpData->AddressMap.ModeTransitionOffset;\r
     CopyMem (\r
       (VOID *)CpuMpData->WakeupBufferHigh,\r
       CpuMpData->AddressMap.RendezvousFunnelAddress +\r
@@ -1081,12 +1096,12 @@ FillExchangeInfoData (
     ExchangeInfo->ModeTransitionMemory = (UINT32)CpuMpData->WakeupBufferHigh;\r
   } else {\r
     ExchangeInfo->ModeTransitionMemory = (UINT32)\r
-      (ExchangeInfo->BufferStart + CpuMpData->AddressMap.ModeTransitionOffset);\r
+                                         (ExchangeInfo->BufferStart + CpuMpData->AddressMap.ModeTransitionOffset);\r
   }\r
 \r
   ExchangeInfo->ModeHighMemory = ExchangeInfo->ModeTransitionMemory +\r
-                         (UINT32)ExchangeInfo->ModeOffset -\r
-                         (UINT32)CpuMpData->AddressMap.ModeTransitionOffset;\r
+                                 (UINT32)ExchangeInfo->ModeOffset -\r
+                                 (UINT32)CpuMpData->AddressMap.ModeTransitionOffset;\r
   ExchangeInfo->ModeHighSegment = (UINT16)ExchangeInfo->CodeSegment;\r
 }\r
 \r
@@ -1100,9 +1115,9 @@ FillExchangeInfoData (
 **/\r
 VOID\r
 TimedWaitForApFinish (\r
-  IN CPU_MP_DATA               *CpuMpData,\r
-  IN UINT32                    FinishedApLimit,\r
-  IN UINT32                    TimeLimit\r
+  IN CPU_MP_DATA  *CpuMpData,\r
+  IN UINT32       FinishedApLimit,\r
+  IN UINT32       TimeLimit\r
   );\r
 \r
 /**\r
@@ -1111,20 +1126,20 @@ TimedWaitForApFinish (
   @param[in]  CpuMpData  The pointer to CPU MP Data structure.\r
 **/\r
 VOID\r
-BackupAndPrepareWakeupBuffer(\r
-  IN CPU_MP_DATA              *CpuMpData\r
+BackupAndPrepareWakeupBuffer (\r
+  IN CPU_MP_DATA  *CpuMpData\r
   )\r
 {\r
   CopyMem (\r
-    (VOID *) CpuMpData->BackupBuffer,\r
-    (VOID *) CpuMpData->WakeupBuffer,\r
+    (VOID *)CpuMpData->BackupBuffer,\r
+    (VOID *)CpuMpData->WakeupBuffer,\r
     CpuMpData->BackupBufferSize\r
     );\r
   CopyMem (\r
-    (VOID *) CpuMpData->WakeupBuffer,\r
-    (VOID *) CpuMpData->AddressMap.RendezvousFunnelAddress,\r
+    (VOID *)CpuMpData->WakeupBuffer,\r
+    (VOID *)CpuMpData->AddressMap.RendezvousFunnelAddress,\r
     CpuMpData->AddressMap.RendezvousFunnelSize +\r
-      CpuMpData->AddressMap.SwitchToRealSize\r
+    CpuMpData->AddressMap.SwitchToRealSize\r
     );\r
 }\r
 \r
@@ -1134,13 +1149,13 @@ BackupAndPrepareWakeupBuffer(
   @param[in]  CpuMpData  The pointer to CPU MP Data structure.\r
 **/\r
 VOID\r
-RestoreWakeupBuffer(\r
-  IN CPU_MP_DATA              *CpuMpData\r
+RestoreWakeupBuffer (\r
+  IN CPU_MP_DATA  *CpuMpData\r
   )\r
 {\r
   CopyMem (\r
-    (VOID *) CpuMpData->WakeupBuffer,\r
-    (VOID *) CpuMpData->BackupBuffer,\r
+    (VOID *)CpuMpData->WakeupBuffer,\r
+    (VOID *)CpuMpData->BackupBuffer,\r
     CpuMpData->BackupBufferSize\r
     );\r
 }\r
@@ -1161,8 +1176,8 @@ GetApResetVectorSize (
   UINTN  Size;\r
 \r
   Size = AddressMap->RendezvousFunnelSize +\r
-           AddressMap->SwitchToRealSize +\r
-           sizeof (MP_CPU_EXCHANGE_INFO);\r
+         AddressMap->SwitchToRealSize +\r
+         sizeof (MP_CPU_EXCHANGE_INFO);\r
 \r
   return Size;\r
 }\r
@@ -1174,21 +1189,21 @@ GetApResetVectorSize (
 **/\r
 VOID\r
 AllocateResetVector (\r
-  IN OUT CPU_MP_DATA          *CpuMpData\r
+  IN OUT CPU_MP_DATA  *CpuMpData\r
   )\r
 {\r
-  UINTN           ApResetVectorSize;\r
-  UINTN           ApResetStackSize;\r
+  UINTN  ApResetVectorSize;\r
+  UINTN  ApResetStackSize;\r
 \r
-  if (CpuMpData->WakeupBuffer == (UINTN) -1) {\r
+  if (CpuMpData->WakeupBuffer == (UINTN)-1) {\r
     ApResetVectorSize = GetApResetVectorSize (&CpuMpData->AddressMap);\r
 \r
     CpuMpData->WakeupBuffer      = GetWakeupBuffer (ApResetVectorSize);\r
-    CpuMpData->MpCpuExchangeInfo = (MP_CPU_EXCHANGE_INFO *) (UINTN)\r
-                    (CpuMpData->WakeupBuffer +\r
-                       CpuMpData->AddressMap.RendezvousFunnelSize +\r
-                       CpuMpData->AddressMap.SwitchToRealSize);\r
-    CpuMpData->WakeupBufferHigh  = GetModeTransitionBuffer (\r
+    CpuMpData->MpCpuExchangeInfo = (MP_CPU_EXCHANGE_INFO *)(UINTN)\r
+                                   (CpuMpData->WakeupBuffer +\r
+                                    CpuMpData->AddressMap.RendezvousFunnelSize +\r
+                                    CpuMpData->AddressMap.SwitchToRealSize);\r
+    CpuMpData->WakeupBufferHigh = GetModeTransitionBuffer (\r
                                     CpuMpData->AddressMap.RendezvousFunnelSize +\r
                                     CpuMpData->AddressMap.SwitchToRealSize -\r
                                     CpuMpData->AddressMap.ModeTransitionOffset\r
@@ -1228,6 +1243,7 @@ AllocateResetVector (
       }\r
     }\r
   }\r
+\r
   BackupAndPrepareWakeupBuffer (CpuMpData);\r
 }\r
 \r
@@ -1238,7 +1254,7 @@ AllocateResetVector (
 **/\r
 VOID\r
 FreeResetVector (\r
-  IN CPU_MP_DATA              *CpuMpData\r
+  IN CPU_MP_DATA  *CpuMpData\r
   )\r
 {\r
   //\r
@@ -1259,10 +1275,10 @@ FreeResetVector (
 **/\r
 VOID\r
 AllocateSevEsAPMemory (\r
-  IN OUT CPU_MP_DATA          *CpuMpData\r
+  IN OUT CPU_MP_DATA  *CpuMpData\r
   )\r
 {\r
-  if (CpuMpData->SevEsAPBuffer == (UINTN) -1) {\r
+  if (CpuMpData->SevEsAPBuffer == (UINTN)-1) {\r
     CpuMpData->SevEsAPBuffer =\r
       CpuMpData->SevEsIsEnabled ? GetSevEsAPMemory () : 0;\r
   }\r
@@ -1278,11 +1294,11 @@ SetSevEsJumpTable (
   IN UINTN  SipiVector\r
   )\r
 {\r
-  SEV_ES_AP_JMP_FAR *JmpFar;\r
-  UINT32            Offset, InsnByte;\r
-  UINT8             LoNib, HiNib;\r
+  SEV_ES_AP_JMP_FAR  *JmpFar;\r
+  UINT32             Offset, InsnByte;\r
+  UINT8              LoNib, HiNib;\r
 \r
-  JmpFar = (SEV_ES_AP_JMP_FAR *) (UINTN) FixedPcdGet32 (PcdSevEsWorkAreaBase);\r
+  JmpFar = (SEV_ES_AP_JMP_FAR *)(UINTN)FixedPcdGet32 (PcdSevEsWorkAreaBase);\r
   ASSERT (JmpFar != NULL);\r
 \r
   //\r
@@ -1290,10 +1306,10 @@ SetSevEsJumpTable (
   // This will be set to a value derived from the SIPI vector and will\r
   // be the memory address used for the far jump below.\r
   //\r
-  Offset = FixedPcdGet32 (PcdSevEsWorkAreaBase);\r
+  Offset  = FixedPcdGet32 (PcdSevEsWorkAreaBase);\r
   Offset += sizeof (JmpFar->InsnBuffer);\r
-  LoNib = (UINT8) Offset;\r
-  HiNib = (UINT8) (Offset >> 8);\r
+  LoNib   = (UINT8)Offset;\r
+  HiNib   = (UINT8)(Offset >> 8);\r
 \r
   //\r
   // Program the workarea (which is the initial AP boot address) with\r
@@ -1302,7 +1318,7 @@ SetSevEsJumpTable (
   //\r
   //   JMP FAR [CS:XXYY] => 2E FF 2E YY XX\r
   //\r
-  InsnByte = 0;\r
+  InsnByte                       = 0;\r
   JmpFar->InsnBuffer[InsnByte++] = 0x2E;  // CS override prefix\r
   JmpFar->InsnBuffer[InsnByte++] = 0xFF;  // JMP (FAR)\r
   JmpFar->InsnBuffer[InsnByte++] = 0x2E;  // ModRM (JMP memory location)\r
@@ -1313,8 +1329,8 @@ SetSevEsJumpTable (
   // Program the Segment/Rip based on the SIPI vector (always at least\r
   // 16-byte aligned, so Rip is set to 0).\r
   //\r
-  JmpFar->Rip = 0;\r
-  JmpFar->Segment = (UINT16) (SipiVector >> 4);\r
+  JmpFar->Rip     = 0;\r
+  JmpFar->Segment = (UINT16)(SipiVector >> 4);\r
 }\r
 \r
 /**\r
@@ -1330,25 +1346,26 @@ SetSevEsJumpTable (
 **/\r
 VOID\r
 WakeUpAP (\r
-  IN CPU_MP_DATA               *CpuMpData,\r
-  IN BOOLEAN                   Broadcast,\r
-  IN UINTN                     ProcessorNumber,\r
-  IN EFI_AP_PROCEDURE          Procedure,              OPTIONAL\r
-  IN VOID                      *ProcedureArgument,     OPTIONAL\r
-  IN BOOLEAN                   WakeUpDisabledAps\r
+  IN CPU_MP_DATA       *CpuMpData,\r
+  IN BOOLEAN           Broadcast,\r
+  IN UINTN             ProcessorNumber,\r
+  IN EFI_AP_PROCEDURE  Procedure               OPTIONAL,\r
+  IN VOID              *ProcedureArgument      OPTIONAL,\r
+  IN BOOLEAN           WakeUpDisabledAps\r
   )\r
 {\r
-  volatile MP_CPU_EXCHANGE_INFO    *ExchangeInfo;\r
-  UINTN                            Index;\r
-  CPU_AP_DATA                      *CpuData;\r
-  BOOLEAN                          ResetVectorRequired;\r
-  CPU_INFO_IN_HOB                  *CpuInfoInHob;\r
+  volatile MP_CPU_EXCHANGE_INFO  *ExchangeInfo;\r
+  UINTN                          Index;\r
+  CPU_AP_DATA                    *CpuData;\r
+  BOOLEAN                        ResetVectorRequired;\r
+  CPU_INFO_IN_HOB                *CpuInfoInHob;\r
 \r
   CpuMpData->FinishedCount = 0;\r
-  ResetVectorRequired = FALSE;\r
+  ResetVectorRequired      = FALSE;\r
 \r
   if (CpuMpData->WakeUpByInitSipiSipi ||\r
-      CpuMpData->InitFlag   != ApInitDone) {\r
+      (CpuMpData->InitFlag   != ApInitDone))\r
+  {\r
     ResetVectorRequired = TRUE;\r
     AllocateResetVector (CpuMpData);\r
     AllocateSevEsAPMemory (CpuMpData);\r
@@ -1375,18 +1392,19 @@ WakeUpAP (
         // the AP procedure will be skipped for disabled AP because AP state\r
         // is not CpuStateReady.\r
         //\r
-        if (GetApState (CpuData) == CpuStateDisabled && !WakeUpDisabledAps) {\r
+        if ((GetApState (CpuData) == CpuStateDisabled) && !WakeUpDisabledAps) {\r
           continue;\r
         }\r
 \r
-        CpuData->ApFunction         = (UINTN) Procedure;\r
-        CpuData->ApFunctionArgument = (UINTN) ProcedureArgument;\r
+        CpuData->ApFunction         = (UINTN)Procedure;\r
+        CpuData->ApFunctionArgument = (UINTN)ProcedureArgument;\r
         SetApState (CpuData, CpuStateReady);\r
         if (CpuMpData->InitFlag != ApInitConfig) {\r
-          *(UINT32 *) CpuData->StartupApSignal = WAKEUP_AP_SIGNAL;\r
+          *(UINT32 *)CpuData->StartupApSignal = WAKEUP_AP_SIGNAL;\r
         }\r
       }\r
     }\r
+\r
     if (ResetVectorRequired) {\r
       //\r
       // For SEV-ES, the initial AP boot address will be defined by\r
@@ -1400,8 +1418,9 @@ WakeUpAP (
       //\r
       // Wakeup all APs\r
       //\r
-      SendInitSipiSipiAllExcludingSelf ((UINT32) ExchangeInfo->BufferStart);\r
+      SendInitSipiSipiAllExcludingSelf ((UINT32)ExchangeInfo->BufferStart);\r
     }\r
+\r
     if (CpuMpData->InitFlag == ApInitConfig) {\r
       if (PcdGet32 (PcdCpuBootLogicalProcessorNumber) > 0) {\r
         //\r
@@ -1462,7 +1481,7 @@ WakeUpAP (
           );\r
 \r
         while (CpuMpData->MpCpuExchangeInfo->NumApsExecuting != 0) {\r
-          CpuPause();\r
+          CpuPause ();\r
         }\r
       }\r
     } else {\r
@@ -1477,17 +1496,17 @@ WakeUpAP (
       }\r
     }\r
   } else {\r
-    CpuData = &CpuMpData->CpuData[ProcessorNumber];\r
-    CpuData->ApFunction         = (UINTN) Procedure;\r
-    CpuData->ApFunctionArgument = (UINTN) ProcedureArgument;\r
+    CpuData                     = &CpuMpData->CpuData[ProcessorNumber];\r
+    CpuData->ApFunction         = (UINTN)Procedure;\r
+    CpuData->ApFunctionArgument = (UINTN)ProcedureArgument;\r
     SetApState (CpuData, CpuStateReady);\r
     //\r
     // Wakeup specified AP\r
     //\r
     ASSERT (CpuMpData->InitFlag != ApInitConfig);\r
-    *(UINT32 *) CpuData->StartupApSignal = WAKEUP_AP_SIGNAL;\r
+    *(UINT32 *)CpuData->StartupApSignal = WAKEUP_AP_SIGNAL;\r
     if (ResetVectorRequired) {\r
-      CpuInfoInHob = (CPU_INFO_IN_HOB *) (UINTN) CpuMpData->CpuInfoInHob;\r
+      CpuInfoInHob = (CPU_INFO_IN_HOB *)(UINTN)CpuMpData->CpuInfoInHob;\r
 \r
       //\r
       // For SEV-ES, the initial AP boot address will be defined by\r
@@ -1500,9 +1519,10 @@ WakeUpAP (
 \r
       SendInitSipiSipi (\r
         CpuInfoInHob[ProcessorNumber].ApicId,\r
-        (UINT32) ExchangeInfo->BufferStart\r
+        (UINT32)ExchangeInfo->BufferStart\r
         );\r
     }\r
+\r
     //\r
     // Wait specified AP waken up\r
     //\r
@@ -1542,8 +1562,8 @@ CalculateTimeout (
   OUT UINT64  *CurrentTime\r
   )\r
 {\r
-  UINT64 TimeoutInSeconds;\r
-  UINT64 TimestampCounterFreq;\r
+  UINT64  TimeoutInSeconds;\r
+  UINT64  TimestampCounterFreq;\r
 \r
   //\r
   // Read the current value of the performance counter\r
@@ -1628,25 +1648,30 @@ CheckTimeout (
   if (Timeout == 0) {\r
     return FALSE;\r
   }\r
+\r
   GetPerformanceCounterProperties (&Start, &End);\r
   Cycle = End - Start;\r
   if (Cycle < 0) {\r
     Cycle = -Cycle;\r
   }\r
+\r
   Cycle++;\r
-  CurrentTime = GetPerformanceCounter();\r
-  Delta = (INT64) (CurrentTime - *PreviousTime);\r
+  CurrentTime = GetPerformanceCounter ();\r
+  Delta       = (INT64)(CurrentTime - *PreviousTime);\r
   if (Start > End) {\r
     Delta = -Delta;\r
   }\r
+\r
   if (Delta < 0) {\r
     Delta += Cycle;\r
   }\r
-  *TotalTime += Delta;\r
+\r
+  *TotalTime   += Delta;\r
   *PreviousTime = CurrentTime;\r
   if (*TotalTime > Timeout) {\r
     return TRUE;\r
   }\r
+\r
   return FALSE;\r
 }\r
 \r
@@ -1660,9 +1685,9 @@ CheckTimeout (
 **/\r
 VOID\r
 TimedWaitForApFinish (\r
-  IN CPU_MP_DATA               *CpuMpData,\r
-  IN UINT32                    FinishedApLimit,\r
-  IN UINT32                    TimeLimit\r
+  IN CPU_MP_DATA  *CpuMpData,\r
+  IN UINT32       FinishedApLimit,\r
+  IN UINT32       TimeLimit\r
   )\r
 {\r
   //\r
@@ -1673,7 +1698,7 @@ TimedWaitForApFinish (
     return;\r
   }\r
 \r
-  CpuMpData->TotalTime = 0;\r
+  CpuMpData->TotalTime    = 0;\r
   CpuMpData->ExpectedTime = CalculateTimeout (\r
                               TimeLimit,\r
                               &CpuMpData->CurrentTime\r
@@ -1683,7 +1708,8 @@ TimedWaitForApFinish (
             &CpuMpData->CurrentTime,\r
             &CpuMpData->TotalTime,\r
             CpuMpData->ExpectedTime\r
-            )) {\r
+            ))\r
+  {\r
     CpuPause ();\r
   }\r
 \r
@@ -1712,10 +1738,10 @@ TimedWaitForApFinish (
 **/\r
 VOID\r
 ResetProcessorToIdleState (\r
-  IN UINTN                     ProcessorNumber\r
+  IN UINTN  ProcessorNumber\r
   )\r
 {\r
-  CPU_MP_DATA           *CpuMpData;\r
+  CPU_MP_DATA  *CpuMpData;\r
 \r
   CpuMpData = GetCpuMpData ();\r
 \r
@@ -1724,6 +1750,7 @@ ResetProcessorToIdleState (
   while (CpuMpData->FinishedCount < 1) {\r
     CpuPause ();\r
   }\r
+\r
   CpuMpData->InitFlag = ApInitDone;\r
 \r
   SetApState (&CpuMpData->CpuData[ProcessorNumber], CpuStateIdle);\r
@@ -1742,11 +1769,11 @@ ResetProcessorToIdleState (
 **/\r
 EFI_STATUS\r
 GetNextWaitingProcessorNumber (\r
-  OUT UINTN                    *NextProcessorNumber\r
+  OUT UINTN  *NextProcessorNumber\r
   )\r
 {\r
-  UINTN           ProcessorNumber;\r
-  CPU_MP_DATA     *CpuMpData;\r
+  UINTN        ProcessorNumber;\r
+  CPU_MP_DATA  *CpuMpData;\r
 \r
   CpuMpData = GetCpuMpData ();\r
 \r
@@ -1773,11 +1800,11 @@ GetNextWaitingProcessorNumber (
 **/\r
 EFI_STATUS\r
 CheckThisAP (\r
-  IN UINTN        ProcessorNumber\r
+  IN UINTN  ProcessorNumber\r
   )\r
 {\r
-  CPU_MP_DATA     *CpuMpData;\r
-  CPU_AP_DATA     *CpuData;\r
+  CPU_MP_DATA  *CpuMpData;\r
+  CPU_AP_DATA  *CpuData;\r
 \r
   CpuMpData = GetCpuMpData ();\r
   CpuData   = &CpuMpData->CpuData[ProcessorNumber];\r
@@ -1790,10 +1817,11 @@ CheckThisAP (
   //\r
   // If the AP finishes for StartupThisAP(), return EFI_SUCCESS.\r
   //\r
-  if (GetApState(CpuData) == CpuStateFinished) {\r
+  if (GetApState (CpuData) == CpuStateFinished) {\r
     if (CpuData->Finished != NULL) {\r
       *(CpuData->Finished) = TRUE;\r
     }\r
+\r
     SetApState (CpuData, CpuStateIdle);\r
     return EFI_SUCCESS;\r
   } else {\r
@@ -1804,6 +1832,7 @@ CheckThisAP (
       if (CpuData->Finished != NULL) {\r
         *(CpuData->Finished) = FALSE;\r
       }\r
+\r
       //\r
       // Reset failed AP to idle state\r
       //\r
@@ -1812,6 +1841,7 @@ CheckThisAP (
       return EFI_TIMEOUT;\r
     }\r
   }\r
+\r
   return EFI_NOT_READY;\r
 }\r
 \r
@@ -1830,12 +1860,12 @@ CheckAllAPs (
   VOID\r
   )\r
 {\r
-  UINTN           ProcessorNumber;\r
-  UINTN           NextProcessorNumber;\r
-  UINTN           ListIndex;\r
-  EFI_STATUS      Status;\r
-  CPU_MP_DATA     *CpuMpData;\r
-  CPU_AP_DATA     *CpuData;\r
+  UINTN        ProcessorNumber;\r
+  UINTN        NextProcessorNumber;\r
+  UINTN        ListIndex;\r
+  EFI_STATUS   Status;\r
+  CPU_MP_DATA  *CpuMpData;\r
+  CPU_AP_DATA  *CpuData;\r
 \r
   CpuMpData = GetCpuMpData ();\r
 \r
@@ -1855,10 +1885,10 @@ CheckAllAPs (
     // Only BSP and corresponding AP access this unit of CPU Data. This means the AP will not modify the\r
     // value of state after setting the it to CpuStateIdle, so BSP can safely make use of its value.\r
     //\r
-    if (GetApState(CpuData) == CpuStateFinished) {\r
-      CpuMpData->RunningCount --;\r
+    if (GetApState (CpuData) == CpuStateFinished) {\r
+      CpuMpData->RunningCount--;\r
       CpuMpData->CpuData[ProcessorNumber].Waiting = FALSE;\r
-      SetApState(CpuData, CpuStateIdle);\r
+      SetApState (CpuData, CpuStateIdle);\r
 \r
       //\r
       // If in Single Thread mode, then search for the next waiting AP for execution.\r
@@ -1870,12 +1900,12 @@ CheckAllAPs (
           WakeUpAP (\r
             CpuMpData,\r
             FALSE,\r
-            (UINT32) NextProcessorNumber,\r
+            (UINT32)NextProcessorNumber,\r
             CpuMpData->Procedure,\r
             CpuMpData->ProcArguments,\r
             TRUE\r
             );\r
-         }\r
+        }\r
       }\r
     }\r
   }\r
@@ -1891,18 +1921,21 @@ CheckAllAPs (
   // If timeout expires, report timeout.\r
   //\r
   if (CheckTimeout (\r
-       &CpuMpData->CurrentTime,\r
-       &CpuMpData->TotalTime,\r
-       CpuMpData->ExpectedTime)\r
-       ) {\r
+        &CpuMpData->CurrentTime,\r
+        &CpuMpData->TotalTime,\r
+        CpuMpData->ExpectedTime\r
+        )\r
+      )\r
+  {\r
     //\r
     // If FailedCpuList is not NULL, record all failed APs in it.\r
     //\r
     if (CpuMpData->FailedCpuList != NULL) {\r
       *CpuMpData->FailedCpuList =\r
-         AllocatePool ((CpuMpData->RunningCount + 1) * sizeof (UINTN));\r
+        AllocatePool ((CpuMpData->RunningCount + 1) * sizeof (UINTN));\r
       ASSERT (*CpuMpData->FailedCpuList != NULL);\r
     }\r
+\r
     ListIndex = 0;\r
 \r
     for (ProcessorNumber = 0; ProcessorNumber < CpuMpData->CpuCount; ProcessorNumber++) {\r
@@ -1920,11 +1953,14 @@ CheckAllAPs (
         }\r
       }\r
     }\r
+\r
     if (CpuMpData->FailedCpuList != NULL) {\r
       (*CpuMpData->FailedCpuList)[ListIndex] = END_OF_CPU_LIST;\r
     }\r
+\r
     return EFI_TIMEOUT;\r
   }\r
+\r
   return EFI_NOT_READY;\r
 }\r
 \r
@@ -1967,16 +2003,17 @@ MpInitLibInitialize (
 \r
   OldCpuMpData = GetCpuMpDataFromGuidedHob ();\r
   if (OldCpuMpData == NULL) {\r
-    MaxLogicalProcessorNumber = PcdGet32(PcdCpuMaxLogicalProcessorNumber);\r
+    MaxLogicalProcessorNumber = PcdGet32 (PcdCpuMaxLogicalProcessorNumber);\r
   } else {\r
     MaxLogicalProcessorNumber = OldCpuMpData->CpuCount;\r
   }\r
+\r
   ASSERT (MaxLogicalProcessorNumber != 0);\r
 \r
   AsmGetAddressMap (&AddressMap);\r
   ApResetVectorSize = GetApResetVectorSize (&AddressMap);\r
-  ApStackSize = PcdGet32(PcdCpuApStackSize);\r
-  ApLoopMode  = GetApLoopMode (&MonitorFilterSize);\r
+  ApStackSize       = PcdGet32 (PcdCpuApStackSize);\r
+  ApLoopMode        = GetApLoopMode (&MonitorFilterSize);\r
 \r
   //\r
   // Save BSP's Control registers for APs.\r
@@ -1993,7 +2030,7 @@ MpInitLibInitialize (
   MpBuffer    = AllocatePages (EFI_SIZE_TO_PAGES (BufferSize));\r
   ASSERT (MpBuffer != NULL);\r
   ZeroMem (MpBuffer, BufferSize);\r
-  Buffer = (UINTN) MpBuffer;\r
+  Buffer = (UINTN)MpBuffer;\r
 \r
   //\r
   //  The layout of the Buffer is as below:\r
@@ -2016,31 +2053,33 @@ MpInitLibInitialize (
   //      CPU_INFO_IN_HOB (N)\r
   //    +--------------------+\r
   //\r
-  MonitorBuffer    = (UINT8 *) (Buffer + ApStackSize * MaxLogicalProcessorNumber);\r
-  BackupBufferAddr = (UINTN) MonitorBuffer + MonitorFilterSize * MaxLogicalProcessorNumber;\r
-  ApIdtBase        = ALIGN_VALUE (BackupBufferAddr + ApResetVectorSize, 8);\r
-  CpuMpData        = (CPU_MP_DATA *) (ApIdtBase + VolatileRegisters.Idtr.Limit + 1);\r
+  MonitorBuffer               = (UINT8 *)(Buffer + ApStackSize * MaxLogicalProcessorNumber);\r
+  BackupBufferAddr            = (UINTN)MonitorBuffer + MonitorFilterSize * MaxLogicalProcessorNumber;\r
+  ApIdtBase                   = ALIGN_VALUE (BackupBufferAddr + ApResetVectorSize, 8);\r
+  CpuMpData                   = (CPU_MP_DATA *)(ApIdtBase + VolatileRegisters.Idtr.Limit + 1);\r
   CpuMpData->Buffer           = Buffer;\r
   CpuMpData->CpuApStackSize   = ApStackSize;\r
   CpuMpData->BackupBuffer     = BackupBufferAddr;\r
   CpuMpData->BackupBufferSize = ApResetVectorSize;\r
-  CpuMpData->WakeupBuffer     = (UINTN) -1;\r
+  CpuMpData->WakeupBuffer     = (UINTN)-1;\r
   CpuMpData->CpuCount         = 1;\r
   CpuMpData->BspNumber        = 0;\r
   CpuMpData->WaitEvent        = NULL;\r
   CpuMpData->SwitchBspFlag    = FALSE;\r
-  CpuMpData->CpuData          = (CPU_AP_DATA *) (CpuMpData + 1);\r
-  CpuMpData->CpuInfoInHob     = (UINT64) (UINTN) (CpuMpData->CpuData + MaxLogicalProcessorNumber);\r
-  InitializeSpinLock(&CpuMpData->MpLock);\r
+  CpuMpData->CpuData          = (CPU_AP_DATA *)(CpuMpData + 1);\r
+  CpuMpData->CpuInfoInHob     = (UINT64)(UINTN)(CpuMpData->CpuData + MaxLogicalProcessorNumber);\r
+  InitializeSpinLock (&CpuMpData->MpLock);\r
   CpuMpData->SevEsIsEnabled = PcdGetBool (PcdSevEsIsEnabled);\r
-  CpuMpData->SevEsAPBuffer  = (UINTN) -1;\r
+  CpuMpData->SevEsAPBuffer  = (UINTN)-1;\r
   CpuMpData->GhcbBase       = PcdGet64 (PcdGhcbBase);\r
 \r
   //\r
   // Make sure no memory usage outside of the allocated buffer.\r
   //\r
-  ASSERT ((CpuMpData->CpuInfoInHob + sizeof (CPU_INFO_IN_HOB) * MaxLogicalProcessorNumber) ==\r
-          Buffer + BufferSize);\r
+  ASSERT (\r
+    (CpuMpData->CpuInfoInHob + sizeof (CPU_INFO_IN_HOB) * MaxLogicalProcessorNumber) ==\r
+    Buffer + BufferSize\r
+    );\r
 \r
   //\r
   // Duplicate BSP's IDT to APs.\r
@@ -2076,6 +2115,7 @@ MpInitLibInitialize (
     CpuMpData->CpuData[Index].StartupApSignal =\r
       (UINT32 *)(MonitorBuffer + MonitorFilterSize * Index);\r
   }\r
+\r
   //\r
   // Enable the local APIC for Virtual Wire Mode.\r
   //\r
@@ -2094,13 +2134,13 @@ MpInitLibInitialize (
     // from HOB\r
     //\r
     OldCpuMpData->NewCpuMpData = CpuMpData;\r
-    CpuMpData->CpuCount  = OldCpuMpData->CpuCount;\r
-    CpuMpData->BspNumber = OldCpuMpData->BspNumber;\r
-    CpuMpData->CpuInfoInHob = OldCpuMpData->CpuInfoInHob;\r
-    CpuInfoInHob = (CPU_INFO_IN_HOB *) (UINTN) CpuMpData->CpuInfoInHob;\r
+    CpuMpData->CpuCount        = OldCpuMpData->CpuCount;\r
+    CpuMpData->BspNumber       = OldCpuMpData->BspNumber;\r
+    CpuMpData->CpuInfoInHob    = OldCpuMpData->CpuInfoInHob;\r
+    CpuInfoInHob               = (CPU_INFO_IN_HOB *)(UINTN)CpuMpData->CpuInfoInHob;\r
     for (Index = 0; Index < CpuMpData->CpuCount; Index++) {\r
-      InitializeSpinLock(&CpuMpData->CpuData[Index].ApLock);\r
-      CpuMpData->CpuData[Index].CpuHealthy = (CpuInfoInHob[Index].Health == 0)? TRUE:FALSE;\r
+      InitializeSpinLock (&CpuMpData->CpuData[Index].ApLock);\r
+      CpuMpData->CpuData[Index].CpuHealthy = (CpuInfoInHob[Index].Health == 0) ? TRUE : FALSE;\r
       CpuMpData->CpuData[Index].ApFunction = 0;\r
     }\r
   }\r
@@ -2108,7 +2148,8 @@ MpInitLibInitialize (
   if (!GetMicrocodePatchInfoFromHob (\r
          &CpuMpData->MicrocodePatchAddress,\r
          &CpuMpData->MicrocodePatchRegionSize\r
-         )) {\r
+         ))\r
+  {\r
     //\r
     // The microcode patch information cache HOB does not exist, which means\r
     // the microcode patches data has not been loaded into memory yet\r
@@ -2137,6 +2178,7 @@ MpInitLibInitialize (
       //\r
       CpuMpData->InitFlag = ApInitReconfig;\r
     }\r
+\r
     WakeUpAP (CpuMpData, TRUE, 0, ApInitializeSync, CpuMpData, TRUE);\r
     //\r
     // Wait for all APs finished initialization\r
@@ -2144,9 +2186,11 @@ MpInitLibInitialize (
     while (CpuMpData->FinishedCount < (CpuMpData->CpuCount - 1)) {\r
       CpuPause ();\r
     }\r
+\r
     if (OldCpuMpData != NULL) {\r
       CpuMpData->InitFlag = ApInitDone;\r
     }\r
+\r
     for (Index = 0; Index < CpuMpData->CpuCount; Index++) {\r
       SetApState (&CpuMpData->CpuData[Index], CpuStateIdle);\r
     }\r
@@ -2155,28 +2199,34 @@ MpInitLibInitialize (
   //\r
   // Dump the microcode revision for each core.\r
   //\r
-  DEBUG_CODE (\r
-    UINT32 ThreadId;\r
-    UINT32 ExpectedMicrocodeRevision;\r
-    CpuInfoInHob = (CPU_INFO_IN_HOB *) (UINTN) CpuMpData->CpuInfoInHob;\r
-    for (Index = 0; Index < CpuMpData->CpuCount; Index++) {\r
-      GetProcessorLocationByApicId (CpuInfoInHob[Index].InitialApicId, NULL, NULL, &ThreadId);\r
-      if (ThreadId == 0) {\r
-        //\r
-        // MicrocodeDetect() loads microcode in first thread of each core, so,\r
-        // CpuMpData->CpuData[Index].MicrocodeEntryAddr is initialized only for first thread of each core.\r
-        //\r
-        ExpectedMicrocodeRevision = 0;\r
-        if (CpuMpData->CpuData[Index].MicrocodeEntryAddr != 0) {\r
-          ExpectedMicrocodeRevision = ((CPU_MICROCODE_HEADER *)(UINTN)CpuMpData->CpuData[Index].MicrocodeEntryAddr)->UpdateRevision;\r
-        }\r
-        DEBUG ((\r
-          DEBUG_INFO, "CPU[%04d]: Microcode revision = %08x, expected = %08x\n",\r
-          Index, CpuMpData->CpuData[Index].MicrocodeRevision, ExpectedMicrocodeRevision\r
-          ));\r
+  DEBUG_CODE_BEGIN ();\r
+  UINT32  ThreadId;\r
+  UINT32  ExpectedMicrocodeRevision;\r
+\r
+  CpuInfoInHob = (CPU_INFO_IN_HOB *)(UINTN)CpuMpData->CpuInfoInHob;\r
+  for (Index = 0; Index < CpuMpData->CpuCount; Index++) {\r
+    GetProcessorLocationByApicId (CpuInfoInHob[Index].InitialApicId, NULL, NULL, &ThreadId);\r
+    if (ThreadId == 0) {\r
+      //\r
+      // MicrocodeDetect() loads microcode in first thread of each core, so,\r
+      // CpuMpData->CpuData[Index].MicrocodeEntryAddr is initialized only for first thread of each core.\r
+      //\r
+      ExpectedMicrocodeRevision = 0;\r
+      if (CpuMpData->CpuData[Index].MicrocodeEntryAddr != 0) {\r
+        ExpectedMicrocodeRevision = ((CPU_MICROCODE_HEADER *)(UINTN)CpuMpData->CpuData[Index].MicrocodeEntryAddr)->UpdateRevision;\r
       }\r
+\r
+      DEBUG ((\r
+        DEBUG_INFO,\r
+        "CPU[%04d]: Microcode revision = %08x, expected = %08x\n",\r
+        Index,\r
+        CpuMpData->CpuData[Index].MicrocodeRevision,\r
+        ExpectedMicrocodeRevision\r
+        ));\r
     }\r
-  );\r
+  }\r
+\r
+  DEBUG_CODE_END ();\r
   //\r
   // Initialize global data for MP support\r
   //\r
@@ -2210,19 +2260,19 @@ MpInitLibGetProcessorInfo (
   OUT EFI_HEALTH_FLAGS           *HealthData  OPTIONAL\r
   )\r
 {\r
-  CPU_MP_DATA            *CpuMpData;\r
-  UINTN                  CallerNumber;\r
-  CPU_INFO_IN_HOB        *CpuInfoInHob;\r
-  UINTN                  OriginalProcessorNumber;\r
+  CPU_MP_DATA      *CpuMpData;\r
+  UINTN            CallerNumber;\r
+  CPU_INFO_IN_HOB  *CpuInfoInHob;\r
+  UINTN            OriginalProcessorNumber;\r
 \r
-  CpuMpData = GetCpuMpData ();\r
-  CpuInfoInHob = (CPU_INFO_IN_HOB *) (UINTN) CpuMpData->CpuInfoInHob;\r
+  CpuMpData    = GetCpuMpData ();\r
+  CpuInfoInHob = (CPU_INFO_IN_HOB *)(UINTN)CpuMpData->CpuInfoInHob;\r
 \r
   //\r
   // Lower 24 bits contains the actual processor number.\r
   //\r
   OriginalProcessorNumber = ProcessorNumber;\r
-  ProcessorNumber &= BIT24 - 1;\r
+  ProcessorNumber        &= BIT24 - 1;\r
 \r
   //\r
   // Check whether caller processor is BSP\r
@@ -2240,14 +2290,16 @@ MpInitLibGetProcessorInfo (
     return EFI_NOT_FOUND;\r
   }\r
 \r
-  ProcessorInfoBuffer->ProcessorId = (UINT64) CpuInfoInHob[ProcessorNumber].ApicId;\r
+  ProcessorInfoBuffer->ProcessorId = (UINT64)CpuInfoInHob[ProcessorNumber].ApicId;\r
   ProcessorInfoBuffer->StatusFlag  = 0;\r
   if (ProcessorNumber == CpuMpData->BspNumber) {\r
     ProcessorInfoBuffer->StatusFlag |= PROCESSOR_AS_BSP_BIT;\r
   }\r
+\r
   if (CpuMpData->CpuData[ProcessorNumber].CpuHealthy) {\r
     ProcessorInfoBuffer->StatusFlag |= PROCESSOR_HEALTH_STATUS_BIT;\r
   }\r
+\r
   if (GetApState (&CpuMpData->CpuData[ProcessorNumber]) == CpuStateDisabled) {\r
     ProcessorInfoBuffer->StatusFlag &= ~PROCESSOR_ENABLED_BIT;\r
   } else {\r
@@ -2296,8 +2348,8 @@ MpInitLibGetProcessorInfo (
 **/\r
 EFI_STATUS\r
 SwitchBSPWorker (\r
-  IN UINTN                     ProcessorNumber,\r
-  IN BOOLEAN                   EnableOldBSP\r
+  IN UINTN    ProcessorNumber,\r
+  IN BOOLEAN  EnableOldBSP\r
   )\r
 {\r
   CPU_MP_DATA                  *CpuMpData;\r
@@ -2370,7 +2422,7 @@ SwitchBSPWorker (
   //\r
   // Clear the BSP bit of MSR_IA32_APIC_BASE\r
   //\r
-  ApicBaseMsr.Uint64 = AsmReadMsr64 (MSR_IA32_APIC_BASE);\r
+  ApicBaseMsr.Uint64   = AsmReadMsr64 (MSR_IA32_APIC_BASE);\r
   ApicBaseMsr.Bits.BSP = 0;\r
   AsmWriteMsr64 (MSR_IA32_APIC_BASE, ApicBaseMsr.Uint64);\r
 \r
@@ -2384,7 +2436,7 @@ SwitchBSPWorker (
   //\r
   // Set the BSP bit of MSR_IA32_APIC_BASE on new BSP\r
   //\r
-  ApicBaseMsr.Uint64 = AsmReadMsr64 (MSR_IA32_APIC_BASE);\r
+  ApicBaseMsr.Uint64   = AsmReadMsr64 (MSR_IA32_APIC_BASE);\r
   ApicBaseMsr.Bits.BSP = 1;\r
   AsmWriteMsr64 (MSR_IA32_APIC_BASE, ApicBaseMsr.Uint64);\r
   ProgramVirtualWireMode ();\r
@@ -2405,10 +2457,11 @@ SwitchBSPWorker (
   } else {\r
     SetApState (&CpuMpData->CpuData[CallerNumber], CpuStateIdle);\r
   }\r
+\r
   //\r
   // Save new BSP number\r
   //\r
-  CpuMpData->BspNumber = (UINT32) ProcessorNumber;\r
+  CpuMpData->BspNumber = (UINT32)ProcessorNumber;\r
 \r
   //\r
   // Restore interrupt state.\r
@@ -2438,13 +2491,13 @@ SwitchBSPWorker (
 **/\r
 EFI_STATUS\r
 EnableDisableApWorker (\r
-  IN  UINTN                     ProcessorNumber,\r
-  IN  BOOLEAN                   EnableAP,\r
-  IN  UINT32                    *HealthFlag OPTIONAL\r
+  IN  UINTN    ProcessorNumber,\r
+  IN  BOOLEAN  EnableAP,\r
+  IN  UINT32   *HealthFlag OPTIONAL\r
   )\r
 {\r
-  CPU_MP_DATA               *CpuMpData;\r
-  UINTN                     CallerNumber;\r
+  CPU_MP_DATA  *CpuMpData;\r
+  UINTN        CallerNumber;\r
 \r
   CpuMpData = GetCpuMpData ();\r
 \r
@@ -2472,7 +2525,7 @@ EnableDisableApWorker (
 \r
   if (HealthFlag != NULL) {\r
     CpuMpData->CpuData[ProcessorNumber].CpuHealthy =\r
-          (BOOLEAN) ((*HealthFlag & PROCESSOR_HEALTH_STATUS_BIT) != 0);\r
+      (BOOLEAN)((*HealthFlag & PROCESSOR_HEALTH_STATUS_BIT) != 0);\r
   }\r
 \r
   return EFI_SUCCESS;\r
@@ -2497,10 +2550,10 @@ EnableDisableApWorker (
 EFI_STATUS\r
 EFIAPI\r
 MpInitLibWhoAmI (\r
-  OUT UINTN                    *ProcessorNumber\r
+  OUT UINTN  *ProcessorNumber\r
   )\r
 {\r
-  CPU_MP_DATA           *CpuMpData;\r
+  CPU_MP_DATA  *CpuMpData;\r
 \r
   if (ProcessorNumber == NULL) {\r
     return EFI_INVALID_PARAMETER;\r
@@ -2534,15 +2587,15 @@ MpInitLibWhoAmI (
 EFI_STATUS\r
 EFIAPI\r
 MpInitLibGetNumberOfProcessors (\r
-  OUT UINTN                     *NumberOfProcessors,       OPTIONAL\r
-  OUT UINTN                     *NumberOfEnabledProcessors OPTIONAL\r
+  OUT UINTN  *NumberOfProcessors        OPTIONAL,\r
+  OUT UINTN  *NumberOfEnabledProcessors OPTIONAL\r
   )\r
 {\r
-  CPU_MP_DATA             *CpuMpData;\r
-  UINTN                   CallerNumber;\r
-  UINTN                   ProcessorNumber;\r
-  UINTN                   EnabledProcessorNumber;\r
-  UINTN                   Index;\r
+  CPU_MP_DATA  *CpuMpData;\r
+  UINTN        CallerNumber;\r
+  UINTN        ProcessorNumber;\r
+  UINTN        EnabledProcessorNumber;\r
+  UINTN        Index;\r
 \r
   CpuMpData = GetCpuMpData ();\r
 \r
@@ -2562,13 +2615,14 @@ MpInitLibGetNumberOfProcessors (
   EnabledProcessorNumber = 0;\r
   for (Index = 0; Index < ProcessorNumber; Index++) {\r
     if (GetApState (&CpuMpData->CpuData[Index]) != CpuStateDisabled) {\r
-      EnabledProcessorNumber ++;\r
+      EnabledProcessorNumber++;\r
     }\r
   }\r
 \r
   if (NumberOfProcessors != NULL) {\r
     *NumberOfProcessors = ProcessorNumber;\r
   }\r
+\r
   if (NumberOfEnabledProcessors != NULL) {\r
     *NumberOfEnabledProcessors = EnabledProcessorNumber;\r
   }\r
@@ -2576,7 +2630,6 @@ MpInitLibGetNumberOfProcessors (
   return EFI_SUCCESS;\r
 }\r
 \r
-\r
 /**\r
   Worker function to execute a caller provided function on all enabled APs.\r
 \r
@@ -2611,23 +2664,23 @@ MpInitLibGetNumberOfProcessors (
 **/\r
 EFI_STATUS\r
 StartupAllCPUsWorker (\r
-  IN  EFI_AP_PROCEDURE          Procedure,\r
-  IN  BOOLEAN                   SingleThread,\r
-  IN  BOOLEAN                   ExcludeBsp,\r
-  IN  EFI_EVENT                 WaitEvent               OPTIONAL,\r
-  IN  UINTN                     TimeoutInMicroseconds,\r
-  IN  VOID                      *ProcedureArgument      OPTIONAL,\r
-  OUT UINTN                     **FailedCpuList         OPTIONAL\r
+  IN  EFI_AP_PROCEDURE  Procedure,\r
+  IN  BOOLEAN           SingleThread,\r
+  IN  BOOLEAN           ExcludeBsp,\r
+  IN  EFI_EVENT         WaitEvent               OPTIONAL,\r
+  IN  UINTN             TimeoutInMicroseconds,\r
+  IN  VOID              *ProcedureArgument      OPTIONAL,\r
+  OUT UINTN             **FailedCpuList         OPTIONAL\r
   )\r
 {\r
-  EFI_STATUS              Status;\r
-  CPU_MP_DATA             *CpuMpData;\r
-  UINTN                   ProcessorCount;\r
-  UINTN                   ProcessorNumber;\r
-  UINTN                   CallerNumber;\r
-  CPU_AP_DATA             *CpuData;\r
-  BOOLEAN                 HasEnabledAp;\r
-  CPU_STATE               ApState;\r
+  EFI_STATUS   Status;\r
+  CPU_MP_DATA  *CpuMpData;\r
+  UINTN        ProcessorCount;\r
+  UINTN        ProcessorNumber;\r
+  UINTN        CallerNumber;\r
+  CPU_AP_DATA  *CpuData;\r
+  BOOLEAN      HasEnabledAp;\r
+  CPU_STATE    ApState;\r
 \r
   CpuMpData = GetCpuMpData ();\r
 \r
@@ -2635,7 +2688,7 @@ StartupAllCPUsWorker (
     *FailedCpuList = NULL;\r
   }\r
 \r
-  if (CpuMpData->CpuCount == 1 && ExcludeBsp) {\r
+  if ((CpuMpData->CpuCount == 1) && ExcludeBsp) {\r
     return EFI_NOT_STARTED;\r
   }\r
 \r
@@ -2687,7 +2740,7 @@ StartupAllCPUsWorker (
 \r
   CpuMpData->RunningCount = 0;\r
   for (ProcessorNumber = 0; ProcessorNumber < ProcessorCount; ProcessorNumber++) {\r
-    CpuData = &CpuMpData->CpuData[ProcessorNumber];\r
+    CpuData          = &CpuMpData->CpuData[ProcessorNumber];\r
     CpuData->Waiting = FALSE;\r
     if (ProcessorNumber != CpuMpData->BspNumber) {\r
       if (CpuData->State == CpuStateIdle) {\r
@@ -2709,8 +2762,8 @@ StartupAllCPUsWorker (
                                TimeoutInMicroseconds,\r
                                &CpuMpData->CurrentTime\r
                                );\r
-  CpuMpData->TotalTime     = 0;\r
-  CpuMpData->WaitEvent     = WaitEvent;\r
+  CpuMpData->TotalTime = 0;\r
+  CpuMpData->WaitEvent = WaitEvent;\r
 \r
   if (!SingleThread) {\r
     WakeUpAP (CpuMpData, TRUE, 0, Procedure, ProcedureArgument, FALSE);\r
@@ -2719,6 +2772,7 @@ StartupAllCPUsWorker (
       if (ProcessorNumber == CallerNumber) {\r
         continue;\r
       }\r
+\r
       if (CpuMpData->CpuData[ProcessorNumber].Waiting) {\r
         WakeUpAP (CpuMpData, FALSE, ProcessorNumber, Procedure, ProcedureArgument, TRUE);\r
         break;\r
@@ -2768,18 +2822,18 @@ StartupAllCPUsWorker (
 **/\r
 EFI_STATUS\r
 StartupThisAPWorker (\r
-  IN  EFI_AP_PROCEDURE          Procedure,\r
-  IN  UINTN                     ProcessorNumber,\r
-  IN  EFI_EVENT                 WaitEvent               OPTIONAL,\r
-  IN  UINTN                     TimeoutInMicroseconds,\r
-  IN  VOID                      *ProcedureArgument      OPTIONAL,\r
-  OUT BOOLEAN                   *Finished               OPTIONAL\r
+  IN  EFI_AP_PROCEDURE  Procedure,\r
+  IN  UINTN             ProcessorNumber,\r
+  IN  EFI_EVENT         WaitEvent               OPTIONAL,\r
+  IN  UINTN             TimeoutInMicroseconds,\r
+  IN  VOID              *ProcedureArgument      OPTIONAL,\r
+  OUT BOOLEAN           *Finished               OPTIONAL\r
   )\r
 {\r
-  EFI_STATUS              Status;\r
-  CPU_MP_DATA             *CpuMpData;\r
-  CPU_AP_DATA             *CpuData;\r
-  UINTN                   CallerNumber;\r
+  EFI_STATUS   Status;\r
+  CPU_MP_DATA  *CpuMpData;\r
+  CPU_AP_DATA  *CpuData;\r
+  UINTN        CallerNumber;\r
 \r
   CpuMpData = GetCpuMpData ();\r
 \r
@@ -2833,7 +2887,7 @@ StartupThisAPWorker (
   // BSP saves data for CheckAPsStatus(), and returns EFI_SUCCESS.\r
   // CheckAPsStatus() will check completion and timeout periodically.\r
   //\r
-  CpuData = &CpuMpData->CpuData[ProcessorNumber];\r
+  CpuData               = &CpuMpData->CpuData[ProcessorNumber];\r
   CpuData->WaitEvent    = WaitEvent;\r
   CpuData->Finished     = Finished;\r
   CpuData->ExpectedTime = CalculateTimeout (TimeoutInMicroseconds, &CpuData->CurrentTime);\r
@@ -2865,16 +2919,17 @@ GetCpuMpDataFromGuidedHob (
   VOID\r
   )\r
 {\r
-  EFI_HOB_GUID_TYPE       *GuidHob;\r
-  VOID                    *DataInHob;\r
-  CPU_MP_DATA             *CpuMpData;\r
+  EFI_HOB_GUID_TYPE  *GuidHob;\r
+  VOID               *DataInHob;\r
+  CPU_MP_DATA        *CpuMpData;\r
 \r
   CpuMpData = NULL;\r
-  GuidHob = GetFirstGuidHob (&mCpuInitMpLibHobGuid);\r
+  GuidHob   = GetFirstGuidHob (&mCpuInitMpLibHobGuid);\r
   if (GuidHob != NULL) {\r
     DataInHob = GET_GUID_HOB_DATA (GuidHob);\r
-    CpuMpData = (CPU_MP_DATA *) (*(UINTN *) DataInHob);\r
+    CpuMpData = (CPU_MP_DATA *)(*(UINTN *)DataInHob);\r
   }\r
+\r
   return CpuMpData;\r
 }\r
 \r
@@ -2907,9 +2962,9 @@ GetCpuMpDataFromGuidedHob (
 EFI_STATUS\r
 EFIAPI\r
 MpInitLibStartupAllCPUs (\r
-  IN  EFI_AP_PROCEDURE          Procedure,\r
-  IN  UINTN                     TimeoutInMicroseconds,\r
-  IN  VOID                      *ProcedureArgument      OPTIONAL\r
+  IN  EFI_AP_PROCEDURE  Procedure,\r
+  IN  UINTN             TimeoutInMicroseconds,\r
+  IN  VOID              *ProcedureArgument      OPTIONAL\r
   )\r
 {\r
   return StartupAllCPUsWorker (\r