generated from Embedded_Projects/YZL_WLE5CB_Template
248 lines
7.2 KiB
C
248 lines
7.2 KiB
C
/* USER CODE BEGIN Header */
|
|
/**
|
|
******************************************************************************
|
|
* @file sys_app.c
|
|
* @author MCD Application Team
|
|
* @brief Initializes HW and SW system entities (not related to the radio)
|
|
******************************************************************************
|
|
* @attention
|
|
*
|
|
* Copyright (c) 2023 STMicroelectronics.
|
|
* All rights reserved.
|
|
*
|
|
* This software is licensed under terms that can be found in the LICENSE file
|
|
* in the root directory of this software component.
|
|
* If no LICENSE file comes with this software, it is provided AS-IS.
|
|
*
|
|
******************************************************************************
|
|
*/
|
|
/* USER CODE END Header */
|
|
|
|
/* Includes ------------------------------------------------------------------*/
|
|
#include <stdio.h>
|
|
#include "platform.h"
|
|
#include "sys_app.h"
|
|
#include "stm32_seq.h"
|
|
#include "stm32_systime.h"
|
|
#include "stm32_lpm.h"
|
|
#include "timer_if.h"
|
|
#include "utilities_def.h"
|
|
#include "sys_debug.h"
|
|
|
|
/* USER CODE BEGIN Includes */
|
|
|
|
/* USER CODE END Includes */
|
|
|
|
/* External variables ---------------------------------------------------------*/
|
|
/* USER CODE BEGIN EV */
|
|
|
|
/* USER CODE END EV */
|
|
|
|
/* Private typedef -----------------------------------------------------------*/
|
|
/* USER CODE BEGIN PTD */
|
|
|
|
/* USER CODE END PTD */
|
|
|
|
/* Private define ------------------------------------------------------------*/
|
|
#define MAX_TS_SIZE (int) 16
|
|
|
|
/* USER CODE BEGIN PD */
|
|
|
|
/* USER CODE END PD */
|
|
|
|
/* Private macro -------------------------------------------------------------*/
|
|
/* USER CODE BEGIN PM */
|
|
|
|
/* USER CODE END PM */
|
|
|
|
/* Private variables ---------------------------------------------------------*/
|
|
static uint8_t SYS_TimerInitialisedFlag = 0;
|
|
|
|
/* USER CODE BEGIN PV */
|
|
|
|
/* USER CODE END PV */
|
|
|
|
/* Private function prototypes -----------------------------------------------*/
|
|
/**
|
|
* @brief Returns sec and msec based on the systime in use
|
|
* @param buff to update with timestamp
|
|
* @param size of updated buffer
|
|
*/
|
|
static void TimestampNow(uint8_t *buff, uint16_t *size);
|
|
|
|
/**
|
|
* @brief it calls UTIL_ADV_TRACE_VSNPRINTF
|
|
*/
|
|
static void tiny_snprintf_like(char *buf, uint32_t maxsize, const char *strFormat, ...);
|
|
|
|
/* USER CODE BEGIN PFP */
|
|
|
|
/* USER CODE END PFP */
|
|
|
|
/* Exported functions ---------------------------------------------------------*/
|
|
void SystemApp_Init(void)
|
|
{
|
|
/* USER CODE BEGIN SystemApp_Init_1 */
|
|
|
|
/* USER CODE END SystemApp_Init_1 */
|
|
|
|
/* Ensure that MSI is wake-up system clock */
|
|
__HAL_RCC_WAKEUPSTOP_CLK_CONFIG(RCC_STOP_WAKEUPCLOCK_MSI);
|
|
|
|
/*Initialize timer and RTC*/
|
|
UTIL_TIMER_Init();
|
|
SYS_TimerInitialisedFlag = 1;
|
|
/* Initializes the SW probes pins and the monitor RF pins via Alternate Function */
|
|
DBG_Init();
|
|
|
|
/*Initialize the terminal */
|
|
UTIL_ADV_TRACE_Init();
|
|
UTIL_ADV_TRACE_RegisterTimeStampFunction(TimestampNow);
|
|
|
|
/*Set verbose LEVEL*/
|
|
UTIL_ADV_TRACE_SetVerboseLevel(VERBOSE_LEVEL);
|
|
|
|
/*Init low power manager*/
|
|
UTIL_LPM_Init();
|
|
/* Disable Stand-by mode */
|
|
UTIL_LPM_SetOffMode((1 << CFG_LPM_APPLI_Id), UTIL_LPM_DISABLE);
|
|
|
|
#if defined (LOW_POWER_DISABLE) && (LOW_POWER_DISABLE == 1)
|
|
/* Disable Stop Mode */
|
|
UTIL_LPM_SetStopMode((1 << CFG_LPM_APPLI_Id), UTIL_LPM_DISABLE);
|
|
#elif !defined (LOW_POWER_DISABLE)
|
|
#error LOW_POWER_DISABLE not defined
|
|
#endif /* LOW_POWER_DISABLE */
|
|
|
|
/* USER CODE BEGIN SystemApp_Init_2 */
|
|
|
|
/* USER CODE END SystemApp_Init_2 */
|
|
}
|
|
|
|
/**
|
|
* @brief redefines __weak function in stm32_seq.c such to enter low power
|
|
*/
|
|
void UTIL_SEQ_Idle(void)
|
|
{
|
|
/* USER CODE BEGIN UTIL_SEQ_Idle_1 */
|
|
|
|
/* USER CODE END UTIL_SEQ_Idle_1 */
|
|
UTIL_LPM_EnterLowPower();
|
|
/* USER CODE BEGIN UTIL_SEQ_Idle_2 */
|
|
|
|
/* USER CODE END UTIL_SEQ_Idle_2 */
|
|
}
|
|
|
|
/* USER CODE BEGIN EF */
|
|
|
|
/* USER CODE END EF */
|
|
|
|
/* Private functions ---------------------------------------------------------*/
|
|
|
|
static void TimestampNow(uint8_t *buff, uint16_t *size)
|
|
{
|
|
/* USER CODE BEGIN TimestampNow_1 */
|
|
|
|
/* USER CODE END TimestampNow_1 */
|
|
SysTime_t curtime = SysTimeGet();
|
|
tiny_snprintf_like((char *)buff, MAX_TS_SIZE, "%ds%03d:", curtime.Seconds, curtime.SubSeconds);
|
|
*size = strlen((char *)buff);
|
|
/* USER CODE BEGIN TimestampNow_2 */
|
|
|
|
/* USER CODE END TimestampNow_2 */
|
|
}
|
|
|
|
/* Disable StopMode when traces need to be printed */
|
|
void UTIL_ADV_TRACE_PreSendHook(void)
|
|
{
|
|
/* USER CODE BEGIN UTIL_ADV_TRACE_PreSendHook_1 */
|
|
|
|
/* USER CODE END UTIL_ADV_TRACE_PreSendHook_1 */
|
|
UTIL_LPM_SetStopMode((1 << CFG_LPM_UART_TX_Id), UTIL_LPM_DISABLE);
|
|
/* USER CODE BEGIN UTIL_ADV_TRACE_PreSendHook_2 */
|
|
|
|
/* USER CODE END UTIL_ADV_TRACE_PreSendHook_2 */
|
|
}
|
|
/* Re-enable StopMode when traces have been printed */
|
|
void UTIL_ADV_TRACE_PostSendHook(void)
|
|
{
|
|
/* USER CODE BEGIN UTIL_LPM_SetStopMode_1 */
|
|
|
|
/* USER CODE END UTIL_LPM_SetStopMode_1 */
|
|
UTIL_LPM_SetStopMode((1 << CFG_LPM_UART_TX_Id), UTIL_LPM_ENABLE);
|
|
/* USER CODE BEGIN UTIL_LPM_SetStopMode_2 */
|
|
|
|
/* USER CODE END UTIL_LPM_SetStopMode_2 */
|
|
}
|
|
|
|
static void tiny_snprintf_like(char *buf, uint32_t maxsize, const char *strFormat, ...)
|
|
{
|
|
/* USER CODE BEGIN tiny_snprintf_like_1 */
|
|
|
|
/* USER CODE END tiny_snprintf_like_1 */
|
|
va_list vaArgs;
|
|
va_start(vaArgs, strFormat);
|
|
UTIL_ADV_TRACE_VSNPRINTF(buf, maxsize, strFormat, vaArgs);
|
|
va_end(vaArgs);
|
|
/* USER CODE BEGIN tiny_snprintf_like_2 */
|
|
|
|
/* USER CODE END tiny_snprintf_like_2 */
|
|
}
|
|
|
|
/* USER CODE BEGIN PrFD */
|
|
|
|
/* USER CODE END PrFD */
|
|
|
|
/* HAL overload functions ---------------------------------------------------------*/
|
|
|
|
/**
|
|
* @note This function overwrites the __weak one from HAL
|
|
*/
|
|
uint32_t HAL_GetTick(void)
|
|
{
|
|
uint32_t ret = 0;
|
|
/* TIMER_IF can be based on other counter the SysTick e.g. RTC */
|
|
/* USER CODE BEGIN HAL_GetTick_1 */
|
|
|
|
/* USER CODE END HAL_GetTick_1 */
|
|
if (SYS_TimerInitialisedFlag == 0)
|
|
{
|
|
/* TIMER_IF_GetTimerValue should be used only once UTIL_TIMER_Init() is initialized */
|
|
/* If HAL_Delay or a TIMEOUT countdown is necessary during initialization phase */
|
|
/* please use temporarily another timebase source (SysTick or TIMx), which implies also */
|
|
/* to rework the above function HAL_InitTick() and to call HAL_IncTick() on the timebase IRQ */
|
|
/* Note: when TIMER_IF is based on RTC, stm32wlxx_hal_rtc.c calls this function before TimeServer is functional */
|
|
/* RTC TIMEOUT will not expire, i.e. if RTC has an hw problem it will keep looping in the RTC_Init function */
|
|
/* USER CODE BEGIN HAL_GetTick_EarlyCall */
|
|
|
|
/* USER CODE END HAL_GetTick_EarlyCall */
|
|
}
|
|
else
|
|
{
|
|
ret = TIMER_IF_GetTimerValue();
|
|
}
|
|
/* USER CODE BEGIN HAL_GetTick_2 */
|
|
|
|
/* USER CODE END HAL_GetTick_2 */
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @note This function overwrites the __weak one from HAL
|
|
*/
|
|
void HAL_Delay(__IO uint32_t Delay)
|
|
{
|
|
/* TIMER_IF can be based on other counter the SysTick e.g. RTC */
|
|
/* USER CODE BEGIN HAL_Delay_1 */
|
|
|
|
/* USER CODE END HAL_Delay_1 */
|
|
TIMER_IF_DelayMs(Delay);
|
|
/* USER CODE BEGIN HAL_Delay_2 */
|
|
|
|
/* USER CODE END HAL_Delay_2 */
|
|
}
|
|
|
|
/* USER CODE BEGIN Overload_HAL_weaks */
|
|
|
|
/* USER CODE END Overload_HAL_weaks */
|