targets: DISCO_H747I add support of MBED_TICKLESS

Author: ABOSTM

targets/TARGET_STM/TARGET_STM32H7/TARGET_STM32H747xI/h747i_sleep.c

@@ -67,6 +67,13 @@
 #define LPTIM_MST_IRQ             LPTIM4_IRQn
 #define LPTIM_MST_RCC             __HAL_RCC_LPTIM4_CLK_ENABLE
 
+#define LPTIM_MST_RCC_CLKAM                  __HAL_RCC_LPTIM4_CLKAM_ENABLE
+
+/* Enable LPTIM wakeup source but only for current core, and disable it for the other core */
+#define LPTIM_MST_EXTI_LPTIM_WAKEUP_CONFIG()  {\
+                                                 HAL_EXTI_D1_EventInputConfig(EXTI_LINE52, EXTI_MODE_IT, ENABLE);\
+                                                 HAL_EXTI_D2_EventInputConfig(EXTI_LINE52, EXTI_MODE_IT, DISABLE);\
+                                               }
 #define LPTIM_MST_RESET_ON        __HAL_RCC_LPTIM4_FORCE_RESET
 #define LPTIM_MST_RESET_OFF       __HAL_RCC_LPTIM4_RELEASE_RESET
 
@@ -85,6 +92,13 @@
 #define LPTIM_MST_IRQ             LPTIM5_IRQn
 #define LPTIM_MST_RCC             __HAL_RCC_LPTIM5_CLK_ENABLE
 
+#define LPTIM_MST_RCC_CLKAM       __HAL_RCC_LPTIM5_CLKAM_ENABLE
+
+/* Enable LPTIM wakeup source but only for current core, and disable it for the other core */
+#define LPTIM_MST_EXTI_LPTIM_WAKEUP_CONFIG()  {\
+                                                 HAL_EXTI_D2_EventInputConfig(EXTI_LINE53, EXTI_MODE_IT, ENABLE);\
+                                                 HAL_EXTI_D1_EventInputConfig(EXTI_LINE53, EXTI_MODE_IT, DISABLE);\
+                                               }
 #define LPTIM_MST_RESET_ON        __HAL_RCC_LPTIM5_FORCE_RESET
 #define LPTIM_MST_RESET_OFF       __HAL_RCC_LPTIM5_RELEASE_RESET
 #else
@@ -209,6 +223,10 @@ void lp_ticker_init(void)
     LPTIM_MST_RESET_ON();
     LPTIM_MST_RESET_OFF();
 #if defined(DUAL_CORE)
+    /* Configure EXTI wakeup and configure autonomous mode */
+    LPTIM_MST_RCC_CLKAM();
+    LPTIM_MST_EXTI_LPTIM_WAKEUP_CONFIG();
+
     LL_HSEM_ReleaseLock(HSEM, CFG_HW_RCC_SEMID, HSEM_CR_COREID_CURRENT);
 #endif /* DUAL_CORE */
 

targets/TARGET_STM/lp_ticker.c

@@ -204,6 +204,25 @@ __WEAK void hal_deepsleep(void)
     if (!pwrClockEnabled) {
         __HAL_RCC_PWR_CLK_DISABLE();
     }
+#elif defined(DUAL_CORE)
+    int lowPowerModeEnabled = LL_PWR_GetRegulModeDS();
+
+#if defined(CORE_CM7)
+    HAL_PWREx_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI, PWR_D3_DOMAIN);
+    HAL_PWREx_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI, PWR_D1_DOMAIN);
+
+#elif defined(CORE_CM4)
+    HAL_PWREx_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI, PWR_D3_DOMAIN);
+    HAL_PWREx_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI, PWR_D2_DOMAIN);
+
+#else
+#error "Wrong Core selection"
+#endif /* CORE_CM7 */
+
+    if (lowPowerModeEnabled) {
+        LL_PWR_SetRegulModeDS(lowPowerModeEnabled);
+    }
+
 #else /* PWR_CR1_LPMS_STOP2 */
     HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI);
 #endif /* PWR_CR1_LPMS_STOP2 */
@@ -220,8 +239,19 @@ __WEAK void hal_deepsleep(void)
     ForceOscOutofDeepSleep();
     ForcePeriphOutofDeepSleep();
 
-    // After wake-up from STOP reconfigure the PLL
+    /* After wake-up from STOP reconfigure the PLL */
+#if defined(DUAL_CORE)
+    while (LL_HSEM_1StepLock(HSEM, CFG_HW_RCC_SEMID)) {
+    }
+
+    if ((LL_RCC_GetSysClkSource() ==  LL_RCC_SYS_CLKSOURCE_STATUS_HSI)) {
+        LL_PWR_ClearFlag_CPU();
+        SetSysClock();
+    }
+    LL_HSEM_ReleaseLock(HSEM, CFG_HW_RCC_SEMID, HSEM_CR_COREID_CURRENT);
+#else
     SetSysClock();
+#endif
 
     /*  Wait for clock to be stabilized.
      *  TO DO: a better way of doing this, would be to rely on

targets/TARGET_STM/sleep.c

@@ -3310,7 +3310,8 @@
         "macros_add": [
             "STM32H747xx",
             "CORE_CM7",
-            "EXTRA_IDLE_STACK_REQUIRED"
+            "EXTRA_IDLE_STACK_REQUIRED",
+            "MBED_TICKLESS"
         ],
         "overrides": { "lpticker_delay_ticks": 0 },
         "supported_form_factors": [
@@ -3353,7 +3354,8 @@
         "macros_add": [
             "STM32H747xx",
             "CORE_CM4",
-            "EXTRA_IDLE_STACK_REQUIRED"
+            "EXTRA_IDLE_STACK_REQUIRED",
+            "MBED_TICKLESS"
         ],
         "overrides": { "lpticker_delay_ticks": 0 },
         "supported_form_factors": [