UefiCpuPkg/MpInitLib: Implementation of MpInitLibGetNumberOfProcessors()

[mirror_edk2.git] / UefiCpuPkg / Library / MpInitLib / DxeMpLib.c

diff --git a/UefiCpuPkg/Library/MpInitLib/DxeMpLib.c b/UefiCpuPkg/Library/MpInitLib/DxeMpLib.c
index 2d8bf25b0add3b53c622221629471f4a8c080a12..762d76dd7a7f2d774dc004acd1f8bc1ab20ce511 100644 (file)
--- a/UefiCpuPkg/Library/MpInitLib/DxeMpLib.c
+++ b/UefiCpuPkg/Library/MpInitLib/DxeMpLib.c
@@ -52,6 +52,65 @@ SaveCpuMpData (
 }\r
 \r
 /**\r
+  Allocate reset vector buffer.\r
+\r
+  @param[in, out]  CpuMpData  The pointer to CPU MP Data structure.\r
+**/\r
+VOID\r
+AllocateResetVector (\r
+  IN OUT CPU_MP_DATA          *CpuMpData\r
+  )\r
+{\r
+  EFI_STATUS            Status;\r
+  UINTN                 ApResetVectorSize;\r
+  EFI_PHYSICAL_ADDRESS  StartAddress;\r
+\r
+  ApResetVectorSize = CpuMpData->AddressMap.RendezvousFunnelSize +\r
+                      sizeof (MP_CPU_EXCHANGE_INFO);\r
+\r
+  StartAddress = BASE_1MB;\r
+  Status = gBS->AllocatePages (\r
+                  AllocateMaxAddress,\r
+                  EfiACPIMemoryNVS,\r
+                  EFI_SIZE_TO_PAGES (ApResetVectorSize),\r
+                  &StartAddress\r
+                  );\r
+  ASSERT_EFI_ERROR (Status);\r
+\r
+  CpuMpData->WakeupBuffer      = (UINTN) StartAddress;\r
+  CpuMpData->MpCpuExchangeInfo = (MP_CPU_EXCHANGE_INFO *) (UINTN)\r
+                  (CpuMpData->WakeupBuffer + CpuMpData->AddressMap.RendezvousFunnelSize);\r
+  //\r
+  // copy AP reset code in it\r
+  //\r
+  CopyMem (\r
+    (VOID *) CpuMpData->WakeupBuffer,\r
+    (VOID *) CpuMpData->AddressMap.RendezvousFunnelAddress,\r
+    CpuMpData->AddressMap.RendezvousFunnelSize\r
+    );\r
+}\r
+\r
+/**\r
+  Free AP reset vector buffer.\r
+\r
+  @param[in]  CpuMpData  The pointer to CPU MP Data structure.\r
+**/\r
+VOID\r
+FreeResetVector (\r
+  IN CPU_MP_DATA              *CpuMpData\r
+  )\r
+{\r
+  EFI_STATUS            Status;\r
+  UINTN                 ApResetVectorSize;\r
+  ApResetVectorSize = CpuMpData->AddressMap.RendezvousFunnelSize +\r
+                      sizeof (MP_CPU_EXCHANGE_INFO);\r
+  Status = gBS->FreePages(\r
+             (EFI_PHYSICAL_ADDRESS)CpuMpData->WakeupBuffer,\r
+             EFI_SIZE_TO_PAGES (ApResetVectorSize)\r
+             );\r
+  ASSERT_EFI_ERROR (Status);\r
+}\r
+\r
 /**\r
   Checks APs status and updates APs status if needed.\r
 \r
@@ -88,6 +147,7 @@ CheckApsStatus (
     CheckAndUpdateApsStatus ();\r
   }\r
 }\r
+\r
 /**\r
   Initialize global data for MP support.\r
 \r