mirror of https://github.com/ARMmbed/mbed-os.git
329 lines
10 KiB
C
329 lines
10 KiB
C
/* mbed Microcontroller Library
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
******************************************************************************
|
|
*
|
|
* Copyright (c) 2015-2021 STMicroelectronics.
|
|
* All rights reserved.
|
|
*
|
|
* This software component is licensed by ST under BSD 3-Clause license,
|
|
* the "License"; You may not use this file except in compliance with the
|
|
* License. You may obtain a copy of the License at:
|
|
* opensource.org/licenses/BSD-3-Clause
|
|
*
|
|
******************************************************************************
|
|
*/
|
|
|
|
#include "cmsis.h"
|
|
#include "objects.h"
|
|
#include "platform/mbed_error.h"
|
|
#include "rtc_api_hal.h"
|
|
|
|
int mbed_sdk_inited = 0;
|
|
extern void SetSysClock(void);
|
|
|
|
#if defined(RCC_LSE_HIGHDRIVE_MODE) || defined(RCC_LSEDRIVE_HIGH)
|
|
# define LSE_CONFIG_AVAILABLE
|
|
#endif
|
|
|
|
// set defaults for LSE drive load level
|
|
#if defined(LSE_CONFIG_AVAILABLE)
|
|
|
|
# if defined(MBED_CONF_TARGET_LSE_DRIVE_LOAD_LEVEL)
|
|
# define LSE_DRIVE_LOAD_LEVEL MBED_CONF_TARGET_LSE_DRIVE_LOAD_LEVEL
|
|
# else
|
|
# if defined(RCC_LSE_HIGHDRIVE_MODE) // STM32F4
|
|
# define LSE_DRIVE_LOAD_LEVEL RCC_LSE_LOWPOWER_MODE
|
|
# else
|
|
# define LSE_DRIVE_LOAD_LEVEL RCC_LSEDRIVE_LOW
|
|
# endif
|
|
# endif
|
|
|
|
|
|
/**
|
|
* @brief configure the LSE crystal driver load
|
|
* This setting is target hardware dependend and
|
|
* depends on the crystal that is used for LSE clock.
|
|
* For low power requirements, crystals with low load capacitors can be used and
|
|
* driver setting is RCC_LSEDRIVE_LOW.
|
|
* For higher stablity, crystals with higher load capacitys can be used and
|
|
* driver setting is RCC_LSEDRIVE_HIGH.
|
|
*
|
|
* A detailed description about this setting can be found here:
|
|
* https://www.st.com/resource/en/application_note/cd00221665-oscillator-design-guide-for-stm8afals-stm32-mcus-and-mpus-stmicroelectronics.pdf
|
|
*
|
|
* LSE maybe used later, but crystal load drive setting is necessary before
|
|
* enabling LSE.
|
|
*
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
|
|
static void LSEDriveConfig(void)
|
|
{
|
|
HAL_PWR_EnableBkUpAccess();
|
|
#if defined(__HAL_RCC_LSEDRIVE_CONFIG)
|
|
__HAL_RCC_LSEDRIVE_CONFIG(LSE_DRIVE_LOAD_LEVEL);
|
|
#else
|
|
HAL_RCCEx_SelectLSEMode(LSE_DRIVE_LOAD_LEVEL);
|
|
#endif
|
|
}
|
|
#endif // LSE_CONFIG_AVAILABLE
|
|
|
|
/**
|
|
* @brief Setup the target board-specific configuration
|
|
* of the microcontroller
|
|
*
|
|
* @note If used, this function should be implemented
|
|
* elsewhere. This declaration is weak so it may be overridden
|
|
* by user code.
|
|
*
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
MBED_WEAK void TargetBSP_Init(void)
|
|
{
|
|
/** Do nothing */
|
|
}
|
|
|
|
#ifndef MBED_DEBUG
|
|
#if MBED_CONF_TARGET_GPIO_RESET_AT_INIT
|
|
void GPIO_Full_Init(void)
|
|
{
|
|
GPIO_InitTypeDef GPIO_InitStruct;
|
|
|
|
GPIO_InitStruct.Pin = GPIO_PIN_All;
|
|
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
#if !TARGET_STM32F1
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
GPIO_InitStruct.Alternate = 0;
|
|
#endif
|
|
#if defined(GPIOA)
|
|
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
__HAL_RCC_GPIOA_CLK_DISABLE();
|
|
#endif
|
|
#if defined(GPIOB)
|
|
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
__HAL_RCC_GPIOB_CLK_DISABLE();
|
|
#endif
|
|
#if defined(GPIOC)
|
|
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
__HAL_RCC_GPIOC_CLK_DISABLE();
|
|
#endif
|
|
#if defined(GPIOD)
|
|
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
HAL_GPIO_Init(GPIOD, &GPIO_InitStruct);
|
|
__HAL_RCC_GPIOD_CLK_DISABLE();
|
|
#endif
|
|
#if defined(GPIOE)
|
|
__HAL_RCC_GPIOE_CLK_ENABLE();
|
|
HAL_GPIO_Init(GPIOE, &GPIO_InitStruct);
|
|
__HAL_RCC_GPIOE_CLK_DISABLE();
|
|
#endif
|
|
#if defined(GPIOF)
|
|
__HAL_RCC_GPIOF_CLK_ENABLE();
|
|
HAL_GPIO_Init(GPIOF, &GPIO_InitStruct);
|
|
__HAL_RCC_GPIOF_CLK_DISABLE();
|
|
#endif
|
|
#if defined(GPIOG)
|
|
__HAL_RCC_GPIOG_CLK_ENABLE();
|
|
HAL_GPIO_Init(GPIOG, &GPIO_InitStruct);
|
|
__HAL_RCC_GPIOG_CLK_DISABLE();
|
|
#endif
|
|
#if defined(GPIOH)
|
|
__HAL_RCC_GPIOH_CLK_ENABLE();
|
|
HAL_GPIO_Init(GPIOH, &GPIO_InitStruct);
|
|
__HAL_RCC_GPIOH_CLK_DISABLE();
|
|
#endif
|
|
#if defined(GPIOI)
|
|
__HAL_RCC_GPIOI_CLK_ENABLE();
|
|
HAL_GPIO_Init(GPIOI, &GPIO_InitStruct);
|
|
__HAL_RCC_GPIOI_CLK_DISABLE();
|
|
#endif
|
|
#if defined(GPIOJ)
|
|
__HAL_RCC_GPIOJ_CLK_ENABLE();
|
|
HAL_GPIO_Init(GPIOJ, &GPIO_InitStruct);
|
|
__HAL_RCC_GPIOJ_CLK_DISABLE();
|
|
#endif
|
|
#if defined(GPIOK)
|
|
__HAL_RCC_GPIOK_CLK_ENABLE();
|
|
HAL_GPIO_Init(GPIOK, &GPIO_InitStruct);
|
|
__HAL_RCC_GPIOK_CLK_DISABLE();
|
|
#endif
|
|
}
|
|
#endif
|
|
#endif
|
|
|
|
// This function is called after RAM initialization and before main.
|
|
void mbed_sdk_init()
|
|
{
|
|
#if defined(__ICACHE_PRESENT) /* STM32F7 */
|
|
// The mbed_sdk_init can be called either during cold boot or during
|
|
// application boot after bootloader has been executed.
|
|
// In case the bootloader has already enabled the cache,
|
|
// is is needed to not enable it again.
|
|
if ((SCB->CCR & (uint32_t)SCB_CCR_IC_Msk) == 0) { // If ICache is disabled
|
|
SCB_EnableICache();
|
|
}
|
|
if ((SCB->CCR & (uint32_t)SCB_CCR_DC_Msk) == 0) { // If DCache is disabled
|
|
SCB_EnableDCache();
|
|
}
|
|
#endif /* __ICACHE_PRESENT */
|
|
|
|
#if defined(DUAL_CORE) && (TARGET_STM32H7)
|
|
/* HW semaphore Clock enable*/
|
|
__HAL_RCC_HSEM_CLK_ENABLE();
|
|
|
|
#if defined(CORE_CM4)
|
|
__HAL_RCC_FLASH_C2_ALLOCATE();
|
|
|
|
/* Check wether CM4 boot in parallel with CM7. If CM4 was gated but CM7 trigger the CM4 boot. No need to wait for synchronization.
|
|
otherwise wait for CM7, which is in charge of sytem clock configuration */
|
|
if (!LL_RCC_IsCM4BootForced()) {
|
|
/* CM4 boots at the same time than CM7. It is necessary to synchronize with CM7, by mean of HSEM, that CM7 finishes its initialization. */
|
|
|
|
/* Activate HSEM notification for Cortex-M4*/
|
|
LL_HSEM_EnableIT_C2IER(HSEM, CFG_HW_STOP_MODE_MASK_SEMID);
|
|
|
|
/*
|
|
* Domain D2 goes to STOP mode (Cortex-M4 in deep-sleep) waiting for
|
|
* Cortex-M7 to perform system initialization (system clock config,
|
|
* external memory configuration.. )
|
|
*/
|
|
|
|
/* Select the domain Power Down DeepSleep */
|
|
LL_PWR_SetRegulModeDS(LL_PWR_REGU_DSMODE_MAIN);
|
|
/* Keep DSTOP mode when D2 domain enters Deepsleep */
|
|
LL_PWR_CPU_SetD2PowerMode(LL_PWR_CPU_MODE_D2STOP);
|
|
LL_PWR_CPU2_SetD2PowerMode(LL_PWR_CPU2_MODE_D2STOP);
|
|
/* Set SLEEPDEEP bit of Cortex System Control Register */
|
|
LL_LPM_EnableDeepSleep();
|
|
|
|
/* Ensure that all instructions done before entering STOP mode */
|
|
__DSB();
|
|
__ISB();
|
|
/* Request Wait For Event */
|
|
__WFE();
|
|
|
|
/* Reset SLEEPDEEP bit of Cortex System Control Register,
|
|
* the following LL API Clear SLEEPDEEP bit of Cortex
|
|
* System Control Register
|
|
*/
|
|
LL_LPM_EnableSleep();
|
|
|
|
/* Clear HSEM flag */
|
|
LL_HSEM_DisableIT_C2IER(HSEM, CFG_HW_STOP_MODE_MASK_SEMID);
|
|
LL_HSEM_ClearFlag_C2ICR(HSEM, CFG_HW_STOP_MODE_MASK_SEMID);
|
|
}
|
|
|
|
// Update the SystemCoreClock variable.
|
|
SystemCoreClockUpdate();
|
|
HAL_Init();
|
|
#else
|
|
/* CORE_M7 */
|
|
// Update the SystemCoreClock variable.
|
|
SystemCoreClockUpdate();
|
|
HAL_Init();
|
|
|
|
/* Configure the System clock source, PLL Multiplier and Divider factors,
|
|
AHB/APBx prescalers and Flash settings */
|
|
#if defined(LSE_CONFIG_AVAILABLE)
|
|
// LSE oscillator drive capability set before LSE is started
|
|
if (!LL_RCC_LSE_IsReady()) {
|
|
LSEDriveConfig();
|
|
}
|
|
#endif
|
|
|
|
#if defined(MBED_CONF_TARGET_SYSTEM_POWER_SUPPLY)
|
|
#if IS_PWR_SUPPLY(MBED_CONF_TARGET_SYSTEM_POWER_SUPPLY)
|
|
HAL_PWREx_ConfigSupply(MBED_CONF_TARGET_SYSTEM_POWER_SUPPLY);
|
|
#else
|
|
#error system_power_supply not configured
|
|
#endif
|
|
#endif
|
|
|
|
SetSysClock();
|
|
SystemCoreClockUpdate();
|
|
|
|
#ifndef CM4_BOOT_BY_APPLICATION
|
|
/* Check wether CM4 boot in parallel with CM7. If CM4 was gated but CM7 trigger the CM4 boot. No need to wait for synchronization.
|
|
otherwise CM7 should wakeup CM4 when system clocks initialization is done. */
|
|
if (READ_BIT(SYSCFG->UR1, SYSCFG_UR1_BCM4)) {
|
|
LL_HSEM_1StepLock(HSEM, CFG_HW_STOP_MODE_SEMID);
|
|
/*Release HSEM in order to notify the CPU2(CM4)*/
|
|
LL_HSEM_ReleaseLock(HSEM, CFG_HW_STOP_MODE_SEMID, 0);
|
|
} else {
|
|
LL_RCC_ForceCM4Boot();
|
|
}
|
|
/* wait until CPU2 wakes up from stop mode */
|
|
while (LL_RCC_D2CK_IsReady() == 0);
|
|
#endif /* CM4_BOOT_BY_APPLICATION */
|
|
#endif /* CORE_M4 */
|
|
|
|
#else /* Single core */
|
|
// Update the SystemCoreClock variable.
|
|
SystemCoreClockUpdate();
|
|
HAL_Init();
|
|
|
|
#if defined(LSE_CONFIG_AVAILABLE)
|
|
// LSE oscillator drive capability set before LSE is started
|
|
if (!LL_RCC_LSE_IsReady()) {
|
|
LSEDriveConfig();
|
|
}
|
|
#endif
|
|
|
|
#if defined(MBED_CONF_TARGET_SYSTEM_POWER_SUPPLY)
|
|
#if IS_PWR_SUPPLY(MBED_CONF_TARGET_SYSTEM_POWER_SUPPLY)
|
|
HAL_PWREx_ConfigSupply(MBED_CONF_TARGET_SYSTEM_POWER_SUPPLY);
|
|
#else
|
|
#error system_power_supply not configured
|
|
#endif
|
|
#endif
|
|
|
|
SetSysClock();
|
|
SystemCoreClockUpdate();
|
|
#endif /* DUAL_CORE */
|
|
|
|
/* Start LSI clock for RTC */
|
|
#if DEVICE_RTC
|
|
#if (MBED_CONF_TARGET_RTC_CLOCK_SOURCE == USE_RTC_CLK_HSE)
|
|
RCC_PeriphCLKInitTypeDef PeriphClkInitStruct = {0};
|
|
PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_RTC;
|
|
PeriphClkInitStruct.RTCClockSelection = (RCC_RTCCLKSOURCE_HSE_DIVX | RTC_HSE_DIV << 16);
|
|
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct) != HAL_OK) {
|
|
error("PeriphClkInitStruct RTC failed with HSE\n");
|
|
}
|
|
#elif ((MBED_CONF_TARGET_RTC_CLOCK_SOURCE == USE_RTC_CLK_LSE_OR_LSI) && !MBED_CONF_TARGET_LSE_AVAILABLE) || (MBED_CONF_TARGET_RTC_CLOCK_SOURCE == USE_RTC_CLK_LSI)
|
|
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
|
|
if (__HAL_RCC_GET_RTC_SOURCE() != RCC_RTCCLKSOURCE_NO_CLK) {
|
|
#if TARGET_STM32WB
|
|
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_LSI1;
|
|
#else
|
|
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_LSI;
|
|
#endif
|
|
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_NONE;
|
|
RCC_OscInitStruct.LSIState = RCC_LSI_ON;
|
|
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK) {
|
|
error("Init : cannot initialize LSI\n");
|
|
}
|
|
}
|
|
#endif /* ! MBED_CONF_TARGET_LSE_AVAILABLE */
|
|
#endif /* DEVICE_RTC */
|
|
|
|
#ifndef MBED_DEBUG
|
|
#if MBED_CONF_TARGET_GPIO_RESET_AT_INIT
|
|
/* Reset all GPIO */
|
|
GPIO_Full_Init();
|
|
#endif
|
|
#endif
|
|
|
|
/* BSP initialization hook (external RAM, etc) */
|
|
TargetBSP_Init();
|
|
|
|
mbed_sdk_inited = 1;
|
|
}
|