168 lines
3.6 KiB
C
168 lines
3.6 KiB
C
/*
|
|
* Copyright (c) 2020-2022, CQ 100ask Development Team
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
* 2022-05-29 Alen first version
|
|
*/
|
|
|
|
#include "drv_common.h"
|
|
|
|
#define DBG_TAG "drv_common"
|
|
#define DBG_LVL DBG_INFO
|
|
#include <rtdbg.h>
|
|
|
|
#ifdef RT_USING_FINSH
|
|
#include <finsh.h>
|
|
static void reboot(uint8_t argc, char **argv)
|
|
{
|
|
rt_hw_cpu_reset();
|
|
}
|
|
MSH_CMD_EXPORT(reboot, Reboot System);
|
|
#endif /* RT_USING_FINSH */
|
|
|
|
volatile uint32_t uwTick;
|
|
static uint32_t _systick_ms = 1;
|
|
void HAL_IncTick(void);
|
|
|
|
/* SysTick configuration */
|
|
void rt_hw_systick_init(void)
|
|
{
|
|
uint32_t prioritygroup = 0x00U;
|
|
uint32_t SystemCoreClock = HAL_GetSysClockFreq();
|
|
/* Configure the SysTick to have interrupt in 1ms time basis*/
|
|
if(SysTick_Config(SystemCoreClock/1000) > 0)
|
|
{
|
|
return;
|
|
}
|
|
/* Configure the SysTick IRQ priority */
|
|
prioritygroup = NVIC_GetPriorityGrouping();
|
|
NVIC_SetPriority(SysTick_IRQn, NVIC_EncodePriority(prioritygroup, 15, 0));
|
|
|
|
_systick_ms = 1000u / RT_TICK_PER_SECOND;
|
|
if(_systick_ms == 0)
|
|
_systick_ms = 1;
|
|
}
|
|
|
|
/**
|
|
* This is the timer interrupt service routine.
|
|
*
|
|
*/
|
|
void SysTick_Handler(void)
|
|
{
|
|
/* enter interrupt */
|
|
rt_interrupt_enter();
|
|
|
|
if(SysTick->CTRL & SysTick_CTRL_COUNTFLAG_Msk)
|
|
HAL_IncTick();
|
|
|
|
rt_tick_increase();
|
|
|
|
/* leave interrupt */
|
|
rt_interrupt_leave();
|
|
}
|
|
|
|
void HAL_IncTick(void)
|
|
{
|
|
uwTick += _systick_ms;
|
|
}
|
|
|
|
/**
|
|
* @brief This function is executed in case of error occurrence.
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
void _Error_Handler(char *s, int num)
|
|
{
|
|
/* USER CODE BEGIN Error_Handler */
|
|
/* User can add his own implementation to report the HAL error return state */
|
|
LOG_E("Error_Handler at file:%s num:%d", s, num);
|
|
while (1)
|
|
{
|
|
}
|
|
/* USER CODE END Error_Handler */
|
|
}
|
|
|
|
/**
|
|
* This function will delay for some us.
|
|
*
|
|
* @param us the delay time of us
|
|
*/
|
|
void rt_hw_us_delay(rt_uint32_t us)
|
|
{
|
|
rt_uint32_t ticks;
|
|
rt_uint32_t told, tnow, tcnt = 0;
|
|
rt_uint32_t reload = SysTick->LOAD;
|
|
|
|
ticks = us * reload / (1000000 / RT_TICK_PER_SECOND);
|
|
told = SysTick->VAL;
|
|
while (1)
|
|
{
|
|
tnow = SysTick->VAL;
|
|
if (tnow != told)
|
|
{
|
|
if (tnow < told)
|
|
{
|
|
tcnt += told - tnow;
|
|
}
|
|
else
|
|
{
|
|
tcnt += reload - tnow + told;
|
|
}
|
|
told = tnow;
|
|
if (tcnt >= ticks)
|
|
{
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/**
|
|
* This function will initial STM32 board.
|
|
*/
|
|
rt_weak void rt_hw_board_init()
|
|
{
|
|
#ifdef BSP_SCB_ENABLE_I_CACHE
|
|
/* Enable I-Cache---------------------------------------------------------*/
|
|
SCB_EnableICache();
|
|
#endif
|
|
|
|
#ifdef BSP_SCB_ENABLE_D_CACHE
|
|
/* Enable D-Cache---------------------------------------------------------*/
|
|
SCB_EnableDCache();
|
|
#endif
|
|
|
|
/* System clock initialization */
|
|
SystemClock_Config();
|
|
|
|
rt_hw_systick_init();
|
|
|
|
/* Heap initialization */
|
|
#if defined(RT_USING_HEAP)
|
|
rt_system_heap_init((void *)HEAP_BEGIN, (void *)HEAP_END);
|
|
#endif
|
|
|
|
/* Pin driver initialization is open by default */
|
|
#ifdef RT_USING_PIN
|
|
rt_hw_pin_init();
|
|
#endif
|
|
|
|
/* USART driver initialization is open by default */
|
|
#ifdef RT_USING_SERIAL
|
|
rt_hw_uart_init();
|
|
#endif
|
|
|
|
/* Set the shell console output device */
|
|
#if defined(RT_USING_CONSOLE) && defined(RT_USING_DEVICE)
|
|
rt_console_set_device(RT_CONSOLE_DEVICE_NAME);
|
|
#endif
|
|
|
|
/* Board underlying hardware initialization */
|
|
#ifdef RT_USING_COMPONENTS_INIT
|
|
rt_components_board_init();
|
|
#endif
|
|
}
|
|
|
|
|