michaelh/zephyr
1
0
Fork 0
Code Releases Activity

soc: stm32wb: Implement ble shutdown sequence

Browse source 
Implement platform shutdown including BLE stack reset and shutdown.

Signed-off-by: Erwan Gouriou <erwan.gouriou@linaro.org>
This commit is contained in:
Erwan Gouriou 2021-10-04 14:38:25 +02:00 • committed by Christopher Friedt
commit b834fbf538
1 changed files with 43 additions and 1 deletions
Download patch file Download diff file Expand all files Collapse all files

44
soc/arm/st_stm32/stm32wb/power.c
View file

@ -16,6 +16,8 @@
#include <clock_control/clock_stm32_ll_common.h>
#include "stm32_hsem.h"
#include <bluetooth/hci.h>
#include <logging/log.h>
LOG_MODULE_DECLARE(soc, CONFIG_SOC_LOG_LEVEL);
@ -40,6 +42,7 @@ static void lpm_hsem_lock(void)
{
/* Implementation of STM32 AN5289 algorithm to enter/exit lowpower */
z_stm32_hsem_lock(CFG_HW_RCC_SEMID, HSEM_LOCK_WAIT_FOREVER);
if (!LL_HSEM_1StepLock(HSEM, CFG_HW_ENTRY_STOP_MODE_SEMID)) {
if (LL_PWR_IsActiveFlag_C2DS()) {
/* Release ENTRY_STOP_MODE semaphore */
@ -54,10 +57,49 @@ static void lpm_hsem_lock(void)
}
}
#define ACI_HAL_STACK_RESET 0xFC3B
static void send_stack_reset(void)
{
struct net_buf *rsp;
int err = 0;
err = bt_hci_cmd_send_sync(ACI_HAL_STACK_RESET, NULL, &rsp);
net_buf_unref(rsp);
if (err) {
LOG_ERR("M0 BLE stack reset issue");
}
}
static void shutdown_ble_stack(void)
{
send_stack_reset();
/* Wait till C2DS set */
while (LL_PWR_IsActiveFlag_C2DS() == 0) {
};
}
/* Invoke Low Power/System Off specific Tasks */
__weak void pm_power_state_set(struct pm_state_info info)
{
if (info.state == PM_STATE_SUSPEND_TO_IDLE) {
if (info.state == PM_STATE_SOFT_OFF) {
if (IS_ENABLED(CONFIG_BT)) {
shutdown_ble_stack();
}
lpm_hsem_lock();
/* Clear all Wake-Up flags */
LL_PWR_ClearFlag_WU();
LL_PWR_SetPowerMode(LL_PWR_MODE_SHUTDOWN);
} else if (info.state == PM_STATE_SUSPEND_TO_IDLE) {
lpm_hsem_lock();