LMS3 and PM update

git-svn-id: https://nuttx.svn.sourceforge.net/svnroot/nuttx/trunk@4902 7fd9a85b-ad96-42d3-883c-3090e2eb8679

1 files changed, 26 insertions, 10 deletions

diff --git a/nuttx/configs/stm3210e-eval/src/up_idle.c b/nuttx/configs/stm3210e-eval/src/up_idle.c
index 9b6432da8..27784056b 100644
--- a/nuttx/configs/stm3210e-eval/src/up_idle.c
+++ b/nuttx/configs/stm3210e-eval/src/up_idle.c
@@ -123,23 +123,43 @@ static void up_idlepm(void)
       switch (newstate)
         {
         case PM_NORMAL:
+
           break;
 
         case PM_IDLE:
+          {          
+            /* Check if the buttons have already been registered */
+
+            up_unregisterbuttons();
+
+            /* Initialize the buttoms to wake up the system from the idle
+             * mode
+             */
+
+            up_pmbuttons();
+          }
           break;
 
         case PM_STANDBY:
-          /* Configure all the buttons as wakeup EXTI */
+          {
+            /* Check if the buttons have already been registered */
+
+            up_unregisterbuttons();
 
-          up_pmbuttons();
+            /* Configure all the buttons as wakeup EXTI */
 
-          /* Call the STM32 stop mode */
+            up_pmbuttons();
 
-          stm32_pmstop(true);
+            /* Call the STM32 stop mode */
+
+            stm32_pmstop(true);
+          }
           break;
 
         case PM_SLEEP:
-          (void)stm32_pmstandby();
+          {
+            (void)stm32_pmstandby();
+          }
           break;
 
         default:
@@ -182,12 +202,8 @@ void up_idle(void)
 
   /* Perform IDLE mode power management */
 
-  up_idlepm();
-
-  /* Sleep until an interrupt occurs to save power */
-
   BEGIN_IDLE();
-  __asm("wfi");
+  up_idlepm();
   END_IDLE();
 #endif
 }