Make the LSE driving capability configurable for the STM32 series. Fixes #44737. Signed-off-by: Benedikt Schmidt <benedikt.schmidt@embedded-solutions.at>
104 lines
2.4 KiB
C
104 lines
2.4 KiB
C
/*
|
|
*
|
|
* Copyright (c) 2017 Linaro Limited.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
|
|
#include <soc.h>
|
|
#include <stm32_ll_bus.h>
|
|
#include <stm32_ll_pwr.h>
|
|
#include <stm32_ll_rcc.h>
|
|
#include <stm32_ll_utils.h>
|
|
#include <drivers/clock_control.h>
|
|
#include <sys/util.h>
|
|
#include <drivers/clock_control/stm32_clock_control.h>
|
|
#include "clock_stm32_ll_common.h"
|
|
#include "stm32_hsem.h"
|
|
|
|
#if STM32_SYSCLK_SRC_PLL
|
|
|
|
/* Macros to fill up division factors values */
|
|
#define z_pllm(v) LL_RCC_PLLM_DIV_ ## v
|
|
#define pllm(v) z_pllm(v)
|
|
|
|
#define z_pllr(v) LL_RCC_PLLR_DIV_ ## v
|
|
#define pllr(v) z_pllr(v)
|
|
|
|
/**
|
|
* @brief Set up pll configuration
|
|
*/
|
|
int config_pll_sysclock(void)
|
|
{
|
|
uint32_t pll_source, pll_m, pll_n, pll_r;
|
|
|
|
#ifdef PWR_CR5_R1MODE
|
|
/* set power boost mode for sys clock greater than 80MHz */
|
|
if (sys_clock_hw_cycles_per_sec() >= MHZ(80)) {
|
|
LL_PWR_EnableRange1BoostMode();
|
|
}
|
|
#endif /* PWR_CR5_R1MODE */
|
|
|
|
pll_n = STM32_PLL_N_MULTIPLIER;
|
|
pll_m = pllm(STM32_PLL_M_DIVISOR);
|
|
pll_r = pllr(STM32_PLL_R_DIVISOR);
|
|
|
|
/* Configure PLL source */
|
|
if (IS_ENABLED(STM32_PLL_SRC_HSI)) {
|
|
pll_source = LL_RCC_PLLSOURCE_HSI;
|
|
} else if (IS_ENABLED(STM32_PLL_SRC_HSE)) {
|
|
pll_source = LL_RCC_PLLSOURCE_HSE;
|
|
} else if (IS_ENABLED(STM32_PLL_SRC_MSI)) {
|
|
pll_source = LL_RCC_PLLSOURCE_MSI;
|
|
} else {
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
LL_RCC_PLL_ConfigDomain_SYS(pll_source, pll_m, pll_n, pll_r);
|
|
|
|
LL_RCC_PLL_EnableDomain_SYS();
|
|
|
|
return 0;
|
|
}
|
|
#endif /* STM32_SYSCLK_SRC_PLL */
|
|
|
|
/**
|
|
* @brief Activate default clocks
|
|
*/
|
|
void config_enable_default_clocks(void)
|
|
{
|
|
#ifdef LL_APB1_GRP1_PERIPH_PWR
|
|
/* Enable the power interface clock */
|
|
LL_APB1_GRP1_EnableClock(LL_APB1_GRP1_PERIPH_PWR);
|
|
#endif
|
|
|
|
#if STM32_LSE_ENABLED
|
|
/* LSE belongs to the back-up domain, enable access.*/
|
|
|
|
#if defined(CONFIG_SOC_SERIES_STM32WBX)
|
|
/* HW semaphore Clock enable */
|
|
LL_AHB3_GRP1_EnableClock(LL_AHB3_GRP1_PERIPH_HSEM);
|
|
#endif
|
|
z_stm32_hsem_lock(CFG_HW_RCC_SEMID, HSEM_LOCK_DEFAULT_RETRY);
|
|
|
|
/* Set the DBP bit in the Power control register 1 (PWR_CR1) */
|
|
LL_PWR_EnableBkUpAccess();
|
|
while (!LL_PWR_IsEnabledBkUpAccess()) {
|
|
/* Wait for Backup domain access */
|
|
}
|
|
|
|
/* Configure driving capability */
|
|
LL_RCC_LSE_SetDriveCapability(STM32_LSE_DRIVING << RCC_BDCR_LSEDRV_Pos);
|
|
/* Enable LSE Oscillator (32.768 kHz) */
|
|
LL_RCC_LSE_Enable();
|
|
while (!LL_RCC_LSE_IsReady()) {
|
|
/* Wait for LSE ready */
|
|
}
|
|
|
|
LL_PWR_DisableBkUpAccess();
|
|
|
|
z_stm32_hsem_unlock(CFG_HW_RCC_SEMID);
|
|
|
|
#endif
|
|
}
|