70 lines
1.9 KiB
C
70 lines
1.9 KiB
C
/*
|
|
* Copyright (c) 2021 Andrés Manelli <am@toroid.io>
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
/** @file
|
|
* @brief System module to support early STM32 MCU configuration
|
|
*/
|
|
|
|
#include <device.h>
|
|
#include <init.h>
|
|
#include <soc.h>
|
|
#include <arch/cpu.h>
|
|
#include <stm32_ll_system.h>
|
|
#include <stm32_ll_bus.h>
|
|
|
|
/**
|
|
* @brief Perform SoC configuration at boot.
|
|
*
|
|
* This should be run early during the boot process but after basic hardware
|
|
* initialization is done.
|
|
*
|
|
* @return 0
|
|
*/
|
|
static int st_stm32_common_config(const struct device *dev)
|
|
{
|
|
#ifdef CONFIG_LOG_BACKEND_SWO
|
|
/* TRACE pin assignment for asynchronous mode */
|
|
DBGMCU->CR &= ~DBGMCU_CR_TRACE_MODE_Msk;
|
|
/* Enable the SWO pin */
|
|
DBGMCU->CR |= DBGMCU_CR_TRACE_IOEN;
|
|
#endif
|
|
|
|
#if defined(CONFIG_USE_SEGGER_RTT)
|
|
/* On some STM32 boards, for unclear reason,
|
|
* RTT feature is working with realtime update only when
|
|
* - one of the DMA is clocked.
|
|
* See https://github.com/zephyrproject-rtos/zephyr/issues/34324
|
|
*/
|
|
#if defined(__HAL_RCC_DMA1_CLK_ENABLE)
|
|
__HAL_RCC_DMA1_CLK_ENABLE();
|
|
#endif /* __HAL_RCC_DMA1_CLK_ENABLE */
|
|
|
|
/* On some STM32 boards, for unclear reason,
|
|
* RTT feature is working with realtime update only when
|
|
* - one of the DBGMCU bit STOP/STANDBY/SLEEP is set
|
|
* See https://github.com/zephyrproject-rtos/zephyr/issues/34324
|
|
*/
|
|
#if defined(LL_APB1_GRP1_PERIPH_DBGMCU)
|
|
LL_APB1_GRP1_EnableClock(LL_APB1_GRP1_PERIPH_DBGMCU);
|
|
#elif defined(LL_APB1_GRP2_PERIPH_DBGMCU)
|
|
LL_APB1_GRP2_EnableClock(LL_APB1_GRP2_PERIPH_DBGMCU);
|
|
#elif defined(LL_APB2_GRP1_PERIPH_DBGMCU)
|
|
LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_DBGMCU);
|
|
#endif /* LL_APB1_GRP1_PERIPH_DBGMCU */
|
|
|
|
#if defined(CONFIG_SOC_SERIES_STM32H7X) || defined(CONFIG_SOC_SERIES_STM32MP1X)
|
|
HAL_EnableDBGSleepMode();
|
|
#else
|
|
LL_DBGMCU_EnableDBGStopMode();
|
|
#endif /* CONFIG_SOC_SERIES_STM32H7X || CONFIG_SOC_SERIES_STM32MP1X */
|
|
|
|
#endif /* CONFIG_USE_SEGGER_RTT */
|
|
|
|
return 0;
|
|
}
|
|
|
|
SYS_INIT(st_stm32_common_config, PRE_KERNEL_1, 1);
|