Update CpuSleep() for IPF.

git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@8315 6f19259b-4bc3-4df7-8a09-765794883524

diff --git a/MdePkg/Library/BaseCpuLib/Ipf/CpuSleep.c b/MdePkg/Library/BaseCpuLib/Ipf/CpuSleep.c
index 796ff5e749b739328e2c6ad75dea685e42cb60d4..fa204d592b6c10878938df30b5d8c7d86d896592 100644 (file)
--- a/MdePkg/Library/BaseCpuLib/Ipf/CpuSleep.c
+++ b/MdePkg/Library/BaseCpuLib/Ipf/CpuSleep.c
@@ -1,7 +1,7 @@
 /** @file\r
   Base Library CPU functions for Itanium\r
 \r
-  Copyright (c) 2006 - 2008, Intel Corporation<BR>\r
+  Copyright (c) 2006 - 2009, Intel Corporation<BR>\r
   All rights reserved. This program and the accompanying materials\r
   are licensed and made available under the terms and conditions of the BSD License\r
   which accompanies this distribution.  The full text of the license may be found at\r
@@ -13,6 +13,7 @@
 **/\r
 \r
 #include <Library/PalLib.h>\r
+#include <Library/BaseLib.h>\r
 \r
 /**\r
   Places the CPU in a sleep state until an interrupt is received.\r
@@ -28,5 +29,38 @@ CpuSleep (
   VOID\r
   )\r
 {\r
-  PalCall (29, 0, 0, 0);\r
+  UINT64  Tpr;\r
+\r
+  //\r
+  // It is the TPR register that controls if external interrupt would bring processor in LIGHT HALT low-power state\r
+  // back to normal state. PAL_HALT_LIGHT does not depend on PSR setting.\r
+  // So here if interrupts are disabled (via PSR.i), TRP.mmi needs to be set to prevent processor being interrupted by external interrupts.\r
+  // If interrupts are enabled, then just use current TRP setting.\r
+  //\r
+  if (GetInterruptState ()) {\r
+    //\r
+    // If interrupts are enabled, then call PAL_HALT_LIGHT with the current TPR setting.\r
+    //\r
+    PalCall (PAL_HALT_LIGHT, 0, 0, 0);\r
+  } else {\r
+    //\r
+    // If interrupts are disabled on entry, then mask all interrupts in TPR before calling PAL_HALT_LIGHT.\r
+    //\r
+\r
+    //\r
+    // Save TPR\r
+    //\r
+    Tpr = AsmReadTpr();\r
+    //\r
+    // Set TPR.mmi to mask all external interrupts\r
+    //\r
+    AsmWriteTpr (BIT16 | Tpr);\r
+\r
+    PalCall (PAL_HALT_LIGHT, 0, 0, 0);\r
+\r
+    //\r
+    // Restore TPR\r
+    //\r
+    AsmWriteTpr (Tpr);\r
+  }\r
 }\r