ArmPkg: Add helper to read the CCSIDR2 register

[mirror_edk2.git] / ArmPkg / Library / ArmLib / Arm / ArmLibSupportV7.S

diff --git a/ArmPkg/Library/ArmLib/Arm/ArmLibSupportV7.S b/ArmPkg/Library/ArmLib/Arm/ArmLibSupportV7.S
index af61dbee52615be54562c61996670cff3672967d..d843f91dfca880439d6e4805c5f6e0c089272276 100644 (file)
--- a/ArmPkg/Library/ArmLib/Arm/ArmLibSupportV7.S
+++ b/ArmPkg/Library/ArmLib/Arm/ArmLibSupportV7.S
@@ -74,6 +74,16 @@ ASM_FUNC(ReadCCSIDR)
   mrc p15,1,r0,c0,c0,0   @ Read current CP15 Cache Size ID Register (CCSIDR)\r
   bx  lr\r
 \r
+// UINT32\r
+// ReadCCSIDR2 (\r
+//   IN UINT32 CSSELR\r
+//   )\r
+ASM_FUNC(ReadCCSIDR2)\r
+  mcr p15,2,r0,c0,c0,0   @ Write Cache Size Selection Register (CSSELR)\r
+  isb\r
+  mrc p15,1,r0,c0,c0,2   @ Read current CP15 Cache Size ID Register (CCSIDR2)\r
+  bx  lr\r
+\r
 // UINT32\r
 // ReadCLIDR (\r
 //   IN UINT32 CSSELR\r