ArmPkg: Add helper to read the CCSIDR2 register

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

diff --git a/ArmPkg/Library/ArmLib/Arm/ArmLibSupportV7.asm b/ArmPkg/Library/ArmLib/Arm/ArmLibSupportV7.asm
index 81f3cb79994c94982f8d390268db48ecbef9c0e0..e14f1566258cc4520a1e16649ba26819b4a97214 100644 (file)
--- a/ArmPkg/Library/ArmLib/Arm/ArmLibSupportV7.asm
+++ b/ArmPkg/Library/ArmLib/Arm/ArmLibSupportV7.asm
@@ -78,6 +78,16 @@
   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
+ RVCT_ASM_EXPORT 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