Update PlatformPrePiLib

Project-Silicium · Jun 22, 2024 · 99b5c2a · 99b5c2a
1 parent 6e7faac
commit 99b5c2a
Show file tree

Hide file tree

Showing 4 changed files with 24 additions and 16 deletions.
diff --git a/Silicon/Qualcomm/SM7325Pkg/Library/PlatformPrePiLib/PlatformPrePiLib.c b/Silicon/Qualcomm/SM7325Pkg/Library/PlatformPrePiLib/PlatformPrePiLib.c
@@ -1,20 +1,22 @@
 #include <Library/IoLib.h>
 #include <Library/PlatformPrePiLib.h>
 #include <Library/PcdLib.h>
+#include <Library/ConfigurationMapHelperLib.h>
 
 #include "PlatformRegisters.h"
 
 VOID
 PlatformInitialize ()
 {
   // Initialize GIC
-  // Wake up redistributor for CPU 0
-  MmioWrite32(
-      GICR_WAKER_CURRENT_CPU,
-      (MmioRead32(GICR_WAKER_CURRENT_CPU) & ~GIC_WAKER_PROCESSORSLEEP));
+  UINT32 EarlyInitCoreCnt = 2;
+  LocateConfigurationMapUINT32ByName("EarlyInitCoreCnt", &EarlyInitCoreCnt);
 
-  // Wake up redistributor for CPU 1
-  MmioWrite32(
-      GICR_WAKER_CPU(1),
-      (MmioRead32(GICR_WAKER_CPU(1)) & ~GIC_WAKER_PROCESSORSLEEP));
+  for (int i = 0; i < EarlyInitCoreCnt; i++)
+  {
+    // Wake up redistributor for CPU i
+    MmioWrite32(
+        GICR_WAKER_CPU(i),
+        (MmioRead32(GICR_WAKER_CPU(i)) & ~GIC_WAKER_PROCESSORSLEEP));
+  }
 }
diff --git a/Silicon/Qualcomm/SM7325Pkg/Library/PlatformPrePiLib/PlatformPrePiLib.inf b/Silicon/Qualcomm/SM7325Pkg/Library/PlatformPrePiLib/PlatformPrePiLib.inf
@@ -13,10 +13,12 @@
   ArmPkg/ArmPkg.dec
   MdePkg/MdePkg.dec
   SiliciumPkg/SiliciumPkg.dec
+  QcomPkg/QcomPkg.dec
 
 [LibraryClasses]
   PcdLib
   IoLib
+  ConfigurationMapHelperLib
 
 [FixedPcd]
   gArmTokenSpaceGuid.PcdGicRedistributorsBase
diff --git a/Silicon/Qualcomm/SM8350Pkg/Library/PlatformPrePiLib/PlatformPrePiLib.c b/Silicon/Qualcomm/SM8350Pkg/Library/PlatformPrePiLib/PlatformPrePiLib.c
@@ -1,20 +1,22 @@
 #include <Library/IoLib.h>
 #include <Library/PlatformPrePiLib.h>
 #include <Library/PcdLib.h>
+#include <Library/ConfigurationMapHelperLib.h>
 
 #include "PlatformRegisters.h"
 
 VOID
 PlatformInitialize ()
 {
   // Initialize GIC
-  // Wake up redistributor for CPU 0
-  MmioWrite32(
-      GICR_WAKER_CURRENT_CPU,
-      (MmioRead32(GICR_WAKER_CURRENT_CPU) & ~GIC_WAKER_PROCESSORSLEEP));
+  UINT32 EarlyInitCoreCnt = 2;
+  LocateConfigurationMapUINT32ByName("EarlyInitCoreCnt", &EarlyInitCoreCnt);
 
-  // Wake up redistributor for CPU 1
-  MmioWrite32(
-      GICR_WAKER_CPU(1),
-      (MmioRead32(GICR_WAKER_CPU(1)) & ~GIC_WAKER_PROCESSORSLEEP));
+  for (int i = 0; i < EarlyInitCoreCnt; i++)
+  {
+    // Wake up redistributor for CPU i
+    MmioWrite32(
+        GICR_WAKER_CPU(i),
+        (MmioRead32(GICR_WAKER_CPU(i)) & ~GIC_WAKER_PROCESSORSLEEP));
+  }
 }
diff --git a/Silicon/Qualcomm/SM8350Pkg/Library/PlatformPrePiLib/PlatformPrePiLib.inf b/Silicon/Qualcomm/SM8350Pkg/Library/PlatformPrePiLib/PlatformPrePiLib.inf
@@ -13,10 +13,12 @@
   ArmPkg/ArmPkg.dec
   MdePkg/MdePkg.dec
   SiliciumPkg/SiliciumPkg.dec
+  QcomPkg/QcomPkg.dec
 
 [LibraryClasses]
   PcdLib
   IoLib
+  ConfigurationMapHelperLib
 
 [FixedPcd]
   gArmTokenSpaceGuid.PcdGicRedistributorsBase