soc: stm32wba: Power: Clean up to be reviewed

Tested with no consumption impact

Signed-off-by: Erwan Gouriou <erwan.gouriou@st.com>

soc/arm/st_stm32/stm32wba/power.c

@@ -7,14 +7,9 @@
 #include <zephyr/pm/pm.h>
 #include <soc.h>
 #include <zephyr/init.h>
-#include <zephyr/drivers/gpio.h>
 
-#include <stm32wbaxx_ll_utils.h>
 #include <stm32wbaxx_ll_bus.h>
-#include <stm32wbaxx_ll_adc.h>
-#include <stm32wbaxx_ll_cortex.h>
 #include <stm32wbaxx_ll_pwr.h>
-#include <stm32wbaxx_hal_pwr_ex.h>
 #include <stm32wbaxx_ll_icache.h>
 #include <stm32wbaxx_ll_rcc.h>
 #include <stm32wbaxx_ll_system.h>
@@ -32,9 +27,11 @@ void set_mode_stop(uint8_t substate_id)
  LL_PWR_ClearFlag_STOP();
  LL_RCC_ClearResetFlags();
 
- while (LL_RCC_HSE_IsReady() == 0) {
- }
+ // EGO: HSE is ready at this point
+ //while (LL_RCC_HSE_IsReady() == 0) {
+ //}
 
+ // EGO: No switch from HSI to HSE at this point
  scm_hserdy_isr();
 
  /* Disabling ICACHE */
@@ -46,9 +43,11 @@ void set_mode_stop(uint8_t substate_id)
  /* Wait until ICACHE_SR.BSYENDF is set */
  while(LL_ICACHE_IsActiveFlag_BSYEND() == 0U);
 
+#ifdef CONFIG_BT_STM32WBA
  scm_setwaitstates(LP);
-
- LL_LPM_EnableDeepSleep();
+#endif
+ // EGO: Done in pm_state_set
+ //LL_LPM_EnableDeepSleep();
 
  while(LL_PWR_IsActiveFlag_ACTVOS( ) == 0) {
  }
@@ -104,17 +103,20 @@ void pm_state_exit_post_ops(enum pm_state state, uint8_t substate_id)
  LL_ICACHE_Enable();
  while(LL_ICACHE_IsEnabled() == 0U);
 
+#ifdef CONFIG_BT_STM32WBA
  if (LL_PWR_IsActiveFlag_STOP() == 1U) {
  scm_setup();
  } else {
  scm_setwaitstates(RUN);
  }
+#endif
 
  switch (state) {
  case PM_STATE_SUSPEND_TO_IDLE:
  if (substate_id <= 2) {
- //LL_LPM_DisableSleepOnExit();
- //LL_LPM_EnableSleep();
+ // EGO: Why removing ?
+ LL_LPM_DisableSleepOnExit();
+ LL_LPM_EnableSleep();
  } else {
  LOG_DBG("Unsupported power substate-id %u",
  substate_id);
@@ -130,8 +132,10 @@ void pm_state_exit_post_ops(enum pm_state state, uint8_t substate_id)
  LOG_DBG("Unsupported power state %u", state);
  break;
  }
+#if !defined(CONFIG_BT_STM32WBA)
  /* need to restore the clock */
- //stm32_clock_control_init(NULL);
+ stm32_clock_control_init(NULL);
+#endif
 
  /*
  * System is now in active mode.
@@ -145,8 +149,8 @@ void pm_state_exit_post_ops(enum pm_state state, uint8_t substate_id)
 static int stm32_power_init(void)
 {
 
-#if CONFIG_BT_STM32WBA
- LL_PWR_SetRegulVoltageScaling(PWR_REGULATOR_VOLTAGE_SCALE2);
+#ifdef CONFIG_BT_STM32WBA
+ // LL_PWR_SetRegulVoltageScaling(PWR_REGULATOR_VOLTAGE_SCALE2);
  scm_init();
 #endif