Merge pull request #7385 from OTAkeys/pr/stm32_pm

cpu/stm32_common: fix stm32f1/2/4 pm

cpu/cortexm_common/include/cpu.h

@@ -96,10 +96,10 @@ static inline void cortexm_sleep(int deep)
     }
 
     /* ensure that all memory accesses have completed and trigger sleeping */
-    __disable_irq();
+    unsigned state = irq_disable();
     __DSB();
     __WFI();
-    __enable_irq();
+    irq_restore(state);
 }
 
 /**

cpu/stm32_common/periph/pm.c

@@ -25,10 +25,22 @@
 
 #include "irq.h"
 #include "periph/pm.h"
+#if defined(CPU_FAM_STM32F1) || defined(CPU_FAM_STM32F2) || defined(CPU_FAM_STM32F4)
+#include "stmclk.h"
+#endif
 
 #define ENABLE_DEBUG (0)
 #include "debug.h"
 
+#ifndef PM_STOP_CONFIG
+/**
+ * @brief Define config flags for stop mode
+ *
+ * Available values can be found in reference manual, PWR section, register CR.
+ */
+#define PM_STOP_CONFIG (PWR_CR_LPDS | PWR_CR_FPDS)
+#endif
+
 void pm_set(unsigned mode)
 {
     int deep = 0;
@@ -49,6 +61,7 @@ void pm_set(unsigned mode)
             /* Clear PDDS and LPDS bits to enter stop mode on */
             /* deepsleep with voltage regulator on */
             PWR->CR &= ~(PWR_CR_PDDS | PWR_CR_LPDS);
+            PWR->CR |= PM_STOP_CONFIG;
             /* Set SLEEPDEEP bit of system control block */
             deep = 1;
             break;
@@ -56,6 +69,13 @@ void pm_set(unsigned mode)
 #endif
 
     cortexm_sleep(deep);
+
+#if defined(CPU_FAM_STM32F1) || defined(CPU_FAM_STM32F2) || defined(CPU_FAM_STM32F4)
+    if (deep) {
+        /* Re-init clock after STOP */
+        stmclk_init_sysclk();
+    }
+#endif
 }
 
 #if defined(CPU_FAM_STM32F1) || defined(CPU_FAM_STM32F2) || defined(CPU_FAM_STM32F4)

cpu/stm32f1/include/periph_cpu.h

@@ -67,6 +67,11 @@ extern "C" {
  */
 #define PM_BLOCKER_INITIAL  { .val_u32 = 0x01010101 }
 
+/**
+ * @brief  Define the config flag for stop mode
+ */
+#define PM_STOP_CONFIG  (PWR_CR_LPDS)
+
 #ifndef DOXYGEN
 /**
  * @brief   Override GPIO mode options