You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
104 lines
2.4 KiB
104 lines
2.4 KiB
/* |
|
* Copyright The Zephyr Project Contributors |
|
* |
|
* SPDX-License-Identifier: Apache-2.0 |
|
*/ |
|
|
|
#include <zephyr/init.h> |
|
#include <zephyr/kernel.h> |
|
#include <zephyr/logging/log.h> |
|
#include <zephyr/pm/pm.h> |
|
|
|
#include <clock_control/clock_stm32_ll_common.h> |
|
#include <stm32u0xx_ll_cortex.h> |
|
#include <stm32u0xx_ll_pwr.h> |
|
#include <stm32u0xx_ll_rcc.h> |
|
|
|
LOG_MODULE_DECLARE(soc, CONFIG_SOC_LOG_LEVEL); |
|
|
|
/* select MSI as wake-up system clock if configured, HSI otherwise */ |
|
#if STM32_SYSCLK_SRC_MSI |
|
#define RCC_STOP_WAKEUPCLOCK_SELECTED LL_RCC_STOP_WAKEUPCLOCK_MSI |
|
#else |
|
#define RCC_STOP_WAKEUPCLOCK_SELECTED LL_RCC_STOP_WAKEUPCLOCK_HSI |
|
#endif |
|
|
|
void set_mode_stop(uint8_t substate_id) |
|
{ |
|
/* ensure the proper wake-up system clock is selected */ |
|
LL_RCC_SetClkAfterWakeFromStop(RCC_STOP_WAKEUPCLOCK_SELECTED); |
|
|
|
switch (substate_id) { |
|
case 1: /* enter STOP0 mode */ |
|
LL_PWR_SetPowerMode(LL_PWR_MODE_STOP0); |
|
break; |
|
case 2: /* enter STOP1 mode */ |
|
LL_PWR_SetPowerMode(LL_PWR_MODE_STOP1); |
|
break; |
|
case 3: /* enter STOP2 mode */ |
|
LL_PWR_SetPowerMode(LL_PWR_MODE_STOP2); |
|
break; |
|
default: |
|
LOG_DBG("Unsupported power state substate-id %u", substate_id); |
|
break; |
|
} |
|
} |
|
|
|
void set_mode_standby(uint8_t substate_id) |
|
{ |
|
ARG_UNUSED(substate_id); |
|
/* Select standby mode */ |
|
LL_PWR_SetPowerMode(LL_PWR_MODE_STANDBY); |
|
} |
|
|
|
/* Invoke Low Power/System Off specific Tasks */ |
|
void pm_state_set(enum pm_state state, uint8_t substate_id) |
|
{ |
|
switch (state) { |
|
case PM_STATE_SUSPEND_TO_IDLE: |
|
set_mode_stop(substate_id); |
|
break; |
|
case PM_STATE_STANDBY: |
|
/* To be tested */ |
|
set_mode_standby(substate_id); |
|
break; |
|
default: |
|
LOG_DBG("Unsupported power state %u", state); |
|
return; |
|
} |
|
|
|
/* Set SLEEPDEEP bit of Cortex System Control Register */ |
|
LL_LPM_EnableDeepSleep(); |
|
|
|
__WFI(); |
|
} |
|
|
|
/* Handle SOC specific activity after Low Power Mode Exit */ |
|
void pm_state_exit_post_ops(enum pm_state state, uint8_t substate_id) |
|
{ |
|
switch (state) { |
|
case PM_STATE_SUSPEND_TO_IDLE: |
|
if (substate_id <= 3) { |
|
LL_LPM_DisableSleepOnExit(); |
|
LL_LPM_EnableSleep(); |
|
} else { |
|
LOG_DBG("Unsupported power substate-id %u", substate_id); |
|
} |
|
break; |
|
case PM_STATE_STANDBY: |
|
/* To be tested */ |
|
LL_LPM_EnableSleep(); |
|
break; |
|
default: |
|
LOG_DBG("Unsupported power state %u", state); |
|
break; |
|
} |
|
/* need to restore the clock */ |
|
stm32_clock_control_init(NULL); |
|
|
|
/* |
|
* System is now in active mode. |
|
* Reenable interrupts which were disabled when OS started idling code. |
|
*/ |
|
irq_unlock(0); |
|
}
|
|
|