600 lines
13 KiB
C
600 lines
13 KiB
C
/********************************** (C) COPYRIGHT *******************************
|
||
* File Name : CH58x_SYS.c
|
||
* Author : WCH
|
||
* Version : V1.2
|
||
* Date : 2021/11/17
|
||
* Description : source file(ch585/ch584)
|
||
*********************************************************************************
|
||
* Copyright (c) 2021 Nanjing Qinheng Microelectronics Co., Ltd.
|
||
* Attention: This software (modified or not) and binary are used for
|
||
* microcontroller manufactured by Nanjing Qinheng Microelectronics.
|
||
*******************************************************************************/
|
||
|
||
#include "CH58x_common.h"
|
||
#include "bsp_uart.h"
|
||
|
||
|
||
volatile MachineMode_Call_func gs_machine_mode_func;
|
||
|
||
extern uint32_t _vector_base[];
|
||
|
||
/*********************************************************************
|
||
* @fn SetSysClock
|
||
*
|
||
* @brief 配置系统运行时钟
|
||
*
|
||
* @param sc - 系统时钟源选择 refer to SYS_CLKTypeDef
|
||
*
|
||
* @return none
|
||
*/
|
||
__HIGH_CODE
|
||
void SetSysClock(SYS_CLKTypeDef sc)
|
||
{
|
||
uint16_t clk_sys_cfg;
|
||
uint8_t i;
|
||
uint8_t x32M_c;
|
||
R32_SAFE_MODE_CTRL |= RB_XROM_312M_SEL;
|
||
R8_SAFE_MODE_CTRL &= ~RB_SAFE_AUTO_EN;
|
||
sys_safe_access_enable();
|
||
if(sc == RB_CLK_SYS_MOD) // 32KHz
|
||
{
|
||
R16_CLK_SYS_CFG |= RB_CLK_SYS_MOD;
|
||
}
|
||
|
||
else
|
||
{
|
||
if(sc & RB_OSC32M_SEL)
|
||
{
|
||
if(!(R8_HFCK_PWR_CTRL & RB_CLK_XT32M_PON))
|
||
{
|
||
x32M_c = R8_XT32M_TUNE;
|
||
R8_XT32M_TUNE |= 0x03;
|
||
R8_HFCK_PWR_CTRL |= RB_CLK_XT32M_PON;
|
||
clk_sys_cfg = R16_CLK_SYS_CFG;
|
||
R16_CLK_SYS_CFG |= 0xC0;
|
||
for(i=0; i<9; i++)
|
||
{
|
||
__nop();
|
||
}
|
||
R16_CLK_SYS_CFG = clk_sys_cfg;
|
||
R8_XT32M_TUNE = x32M_c;
|
||
}
|
||
}
|
||
else
|
||
{
|
||
R8_HFCK_PWR_CTRL |= RB_CLK_RC16M_PON;
|
||
}
|
||
|
||
if(sc & RB_XROM_SCLK_SEL) // PLL div
|
||
{
|
||
R8_HFCK_PWR_CTRL |= RB_CLK_PLL_PON;
|
||
if((sc&0x1F) == 0 )
|
||
{
|
||
R8_FLASH_SCK = R8_FLASH_SCK|(1<<4);
|
||
R8_FLASH_CFG = 0X07;
|
||
}
|
||
else if((sc&0x1F) < 10)
|
||
{
|
||
R8_FLASH_SCK = R8_FLASH_SCK & (~(1<<4));
|
||
R8_FLASH_CFG = 0X02;
|
||
}
|
||
else if((sc&0x1F) < 16)
|
||
{
|
||
R8_FLASH_SCK = R8_FLASH_SCK & (~(1<<4));
|
||
R8_FLASH_CFG = 0X03;
|
||
}
|
||
else
|
||
{
|
||
R8_FLASH_SCK = R8_FLASH_SCK|(1<<4);
|
||
R8_FLASH_CFG = 0X03;
|
||
}
|
||
}
|
||
else
|
||
{
|
||
if((sc&0x1F) < 8 )
|
||
{
|
||
R8_FLASH_SCK = R8_FLASH_SCK & (~(1<<4));
|
||
R8_FLASH_CFG = 0X51;
|
||
}
|
||
else
|
||
{
|
||
R8_FLASH_SCK = R8_FLASH_SCK & (~(1<<4));
|
||
R8_FLASH_CFG = 0X57;
|
||
}
|
||
}
|
||
|
||
R16_CLK_SYS_CFG = sc|0xC0;
|
||
R16_CLK_SYS_CFG = sc;
|
||
|
||
if(sc & RB_OSC32M_SEL)
|
||
{
|
||
if((!((R8_GLOB_CFG_INFO & RB_CFG_DEBUG_EN)|(R8_GLOB_CFG_INFO & RB_CFG_ROM_READ ))) && (R8_SAFE_DEBUG_CTRL & RB_DEBUG_DIS))
|
||
{
|
||
R8_HFCK_PWR_CTRL &= ~RB_CLK_RC16M_PON;
|
||
}
|
||
}
|
||
else
|
||
{
|
||
R8_HFCK_PWR_CTRL &= ~RB_CLK_XT32M_PON;
|
||
}
|
||
|
||
}
|
||
R8_SAFE_MODE_CTRL |= RB_SAFE_AUTO_EN;
|
||
sys_safe_access_disable();
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn highcode_init
|
||
*
|
||
* @brief 搬运highcode代码
|
||
*
|
||
* @param none
|
||
*
|
||
* @return none
|
||
*/
|
||
__attribute__((section(".highcode_init")))
|
||
void highcode_init(void)
|
||
{
|
||
R32_SAFE_MODE_CTRL |= RB_XROM_312M_SEL;
|
||
R8_SAFE_MODE_CTRL &= ~RB_SAFE_AUTO_EN;
|
||
sys_safe_access_enable();
|
||
R32_MISC_CTRL |= 5; //
|
||
R8_PLL_CONFIG &= ~(1 << 5); //
|
||
R8_HFCK_PWR_CTRL |= RB_CLK_RC16M_PON | RB_CLK_PLL_PON;
|
||
R16_CLK_SYS_CFG = CLK_SOURCE_HSI_PLL_62_4MHz;
|
||
R8_FLASH_CFG = 0X02;
|
||
R8_XT32M_TUNE = (R8_XT32M_TUNE&(~0x03))|0x01;
|
||
R8_SAFE_MODE_CTRL |= RB_SAFE_AUTO_EN;
|
||
sys_safe_access_disable();
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn MachineMode_Call_IRQ
|
||
*
|
||
* @brief 机械模式调用函数使用的中断
|
||
*
|
||
* @param none
|
||
*
|
||
* @return none
|
||
*/
|
||
__HIGH_CODE
|
||
__INTERRUPT
|
||
void MachineMode_Call_IRQ(void)
|
||
{
|
||
if(gs_machine_mode_func != NULL)
|
||
{
|
||
gs_machine_mode_func();
|
||
gs_machine_mode_func = NULL;
|
||
}
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn MachineMode_Call
|
||
*
|
||
* @brief 注册机械模式执行函数，并在机械模式下调用
|
||
*
|
||
* @param func - 用于在机械模式下执行的函数
|
||
*
|
||
* @return none
|
||
*/
|
||
__HIGH_CODE
|
||
void MachineMode_Call(MachineMode_Call_func func)
|
||
{
|
||
uint8_t i;
|
||
uint32_t sw_vtf, sw_irqtable;
|
||
uint32_t irqv;
|
||
|
||
/* 这里关闭所有中断 */
|
||
irqv = (PFIC->ISR[0] >> 8) | (PFIC->ISR[1] << 24);
|
||
PFIC->IRER[0] = 0xffffffff;
|
||
PFIC->IRER[1] = 0xffffffff;
|
||
|
||
/* 如果用户使用了SW中断的免表中断，则需要取消此函数所有注释 */
|
||
// for(i = 0; i < 4; i++)
|
||
// {
|
||
// if(PFIC->VTFIDR[i] == SWI_IRQn)
|
||
// {
|
||
// /* 找到了用户自己使用的SW中断，关闭它 */
|
||
// sw_vtf = PFIC->VTFADDR[i];
|
||
// PFIC->VTFADDR[i] = (sw_vtf & 0xFFFFFFFE);
|
||
// break;
|
||
// }
|
||
// }
|
||
|
||
sw_irqtable = _vector_base[SWI_IRQn];
|
||
_vector_base[SWI_IRQn] = (uint32_t)MachineMode_Call_IRQ;
|
||
gs_machine_mode_func = func;
|
||
|
||
/* 只打开SWI_IRQn */
|
||
PFIC_EnableIRQ(SWI_IRQn);
|
||
/* 进入SWI_IRQn中断处理函数 */
|
||
PFIC_SetPendingIRQ(SWI_IRQn);
|
||
|
||
/* 等待处理结束 */
|
||
while(gs_machine_mode_func != NULL);
|
||
|
||
PFIC_DisableIRQ(SWI_IRQn);
|
||
|
||
// if(i != 4)
|
||
// {
|
||
// /* 恢复原本的SW免表中断 */
|
||
// PFIC->VTFADDR[i] = sw_vtf;
|
||
// }
|
||
|
||
/* 这里恢复原来的中断使能配置 */
|
||
PFIC->IENR[0] = (irqv << 8);
|
||
PFIC->IENR[1] = (irqv >> 24);
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn SetPI_func
|
||
*
|
||
* @brief 用于机械模式调用的使能预取指令函数
|
||
*
|
||
* @param none
|
||
*
|
||
* @return none
|
||
*/void SetPI_func()
|
||
{
|
||
write_csr(0xbc0, 0x25);
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn SYS_EnablePI
|
||
*
|
||
* @brief 使能预取指令功能
|
||
*
|
||
* @param none
|
||
*
|
||
* @return null
|
||
*/
|
||
void SYS_EnablePI()
|
||
{
|
||
MachineMode_Call(SetPI_func);
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn GetSysClock
|
||
*
|
||
* @brief 获取当前系统时钟
|
||
*
|
||
* @param none
|
||
*
|
||
* @return Hz
|
||
*/
|
||
uint32_t GetSysClock(void)
|
||
{
|
||
if((R16_CLK_SYS_CFG & RB_CLK_SYS_MOD) == RB_CLK_SYS_MOD)
|
||
{ // 32K做主频
|
||
return (CAB_LSIFQ);
|
||
}
|
||
else if(R16_CLK_SYS_CFG & RB_XROM_SCLK_SEL)
|
||
{
|
||
if(!(R16_CLK_SYS_CFG & 0x1f))
|
||
{
|
||
return ((R16_CLK_SYS_CFG & RB_OSC32M_SEL)?32000000:16000000);
|
||
}
|
||
else
|
||
{ // PLL进行分频
|
||
return (312000000 / (R16_CLK_SYS_CFG & 0x1f));
|
||
}
|
||
}
|
||
else if(R16_CLK_SYS_CFG & RB_OSC32M_SEL)
|
||
{ // 32M进行分频
|
||
return (32000000 / (R16_CLK_SYS_CFG & 0x1f));
|
||
}
|
||
else
|
||
{ // 16M进行分频
|
||
return (16000000 / (R16_CLK_SYS_CFG & 0x1f));
|
||
}
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn SYS_GetInfoSta
|
||
*
|
||
* @brief 获取当前系统信息状态
|
||
*
|
||
* @param i - refer to SYS_InfoStaTypeDef
|
||
*
|
||
* @return 是否开启
|
||
*/
|
||
uint8_t SYS_GetInfoSta(SYS_InfoStaTypeDef i)
|
||
{
|
||
if(i == STA_SAFEACC_ACT)
|
||
{
|
||
return (R8_SAFE_ACCESS_SIG & RB_SAFE_ACC_ACT);
|
||
}
|
||
else
|
||
{
|
||
return (R8_GLOB_CFG_INFO & (1 << i));
|
||
}
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn SYS_ResetExecute
|
||
*
|
||
* @brief 执行系统软件复位
|
||
*
|
||
* @param none
|
||
*
|
||
* @return none
|
||
*/
|
||
__HIGH_CODE
|
||
void SYS_ResetExecute(void)
|
||
{
|
||
FLASH_ROM_SW_RESET();
|
||
sys_safe_access_enable();
|
||
R8_RST_WDOG_CTRL |= RB_SOFTWARE_RESET;
|
||
sys_safe_access_disable();
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn SYS_DisableAllIrq
|
||
*
|
||
* @brief 关闭所有中断，并保留当前中断值
|
||
*
|
||
* @param pirqv - 当前保留中断值
|
||
*
|
||
* @return none
|
||
*/
|
||
void SYS_DisableAllIrq(uint32_t *pirqv)
|
||
{
|
||
*pirqv = (PFIC->ISR[0] >> 8) | (PFIC->ISR[1] << 24);
|
||
PFIC->IRER[0] = 0xffffffff;
|
||
PFIC->IRER[1] = 0xffffffff;
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn SYS_RecoverIrq
|
||
*
|
||
* @brief 恢复之前关闭的中断值
|
||
*
|
||
* @param irq_status - 当前保留中断值
|
||
*
|
||
* @return none
|
||
*/
|
||
void SYS_RecoverIrq(uint32_t irq_status)
|
||
{
|
||
PFIC->IENR[0] = (irq_status << 8);
|
||
PFIC->IENR[1] = (irq_status >> 24);
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn SYS_GetSysTickCnt
|
||
*
|
||
* @brief 获取当前系统(SYSTICK)计数值
|
||
*
|
||
* @param none
|
||
*
|
||
* @return 当前计数值
|
||
*/
|
||
uint32_t SYS_GetSysTickCnt(void)
|
||
{
|
||
return SysTick->CNTL;
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn WWDG_ITCfg
|
||
*
|
||
* @brief 看门狗定时器溢出中断使能
|
||
*
|
||
* @param s - 溢出是否中断
|
||
*
|
||
* @return none
|
||
*/
|
||
void WWDG_ITCfg(FunctionalState s)
|
||
{
|
||
uint8_t ctrl = R8_RST_WDOG_CTRL;
|
||
|
||
if(s == DISABLE)
|
||
{
|
||
ctrl &= ~RB_WDOG_INT_EN;
|
||
}
|
||
else
|
||
{
|
||
ctrl |= RB_WDOG_INT_EN;
|
||
}
|
||
|
||
sys_safe_access_enable();
|
||
R8_RST_WDOG_CTRL = ctrl;
|
||
sys_safe_access_disable();
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn WWDG_ResetCfg
|
||
*
|
||
* @brief 看门狗定时器复位功能
|
||
*
|
||
* @param s - 溢出是否复位
|
||
*
|
||
* @return none
|
||
*/
|
||
void WWDG_ResetCfg(FunctionalState s)
|
||
{
|
||
uint8_t ctrl = R8_RST_WDOG_CTRL;
|
||
|
||
if(s == DISABLE)
|
||
{
|
||
ctrl &= ~RB_WDOG_RST_EN;
|
||
}
|
||
else
|
||
{
|
||
ctrl |= RB_WDOG_RST_EN;
|
||
}
|
||
|
||
sys_safe_access_enable();
|
||
R8_RST_WDOG_CTRL = ctrl;
|
||
sys_safe_access_disable();
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn WWDG_ClearFlag
|
||
*
|
||
* @brief 清除看门狗中断标志，重新加载计数值也可清除
|
||
*
|
||
* @param none
|
||
*
|
||
* @return none
|
||
*/
|
||
void WWDG_ClearFlag(void)
|
||
{
|
||
sys_safe_access_enable();
|
||
R8_RST_WDOG_CTRL |= RB_WDOG_INT_FLAG;
|
||
sys_safe_access_disable();
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn HardFault_Handler
|
||
*
|
||
* @brief 硬件错误中断，进入后执行复位，复位类型为上电复位
|
||
*
|
||
* @param none
|
||
*
|
||
* @return none
|
||
*/
|
||
__INTERRUPT
|
||
__HIGH_CODE
|
||
__attribute__((weak))
|
||
void HardFault_Handler(void)
|
||
{
|
||
FLASH_ROM_SW_RESET();
|
||
sys_safe_access_enable();
|
||
R16_INT32K_TUNE = 0xFFFF;
|
||
sys_safe_access_disable();
|
||
sys_safe_access_enable();
|
||
R8_RST_WDOG_CTRL |= RB_SOFTWARE_RESET;
|
||
sys_safe_access_disable();
|
||
while(1);
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn mDelayuS
|
||
*
|
||
* @brief uS 延时
|
||
*
|
||
* @param t - 时间参数
|
||
*
|
||
* @return none
|
||
*/
|
||
__HIGH_CODE
|
||
void mDelayuS(uint16_t t)
|
||
{
|
||
uint32_t i;
|
||
#if(FREQ_SYS == 78000000)
|
||
i = t * 13;
|
||
#elif(FREQ_SYS == 62400000)
|
||
i = ((uint32_t)t * 78) / 5;
|
||
#elif(FREQ_SYS == 52000000)
|
||
i = t * 13;
|
||
#elif(FREQ_SYS == 39000000)
|
||
i = (t * 13)>>1;
|
||
#elif(FREQ_SYS == 26000000)
|
||
i = (t * 13)>>1;
|
||
#elif(FREQ_SYS == 24000000)
|
||
i = t * 6;
|
||
#elif(FREQ_SYS == 19500000)
|
||
i = (t * 13)>>2;
|
||
#elif(FREQ_SYS == 32000000)
|
||
i = t << 3;
|
||
#elif(FREQ_SYS == 16000000)
|
||
i = t << 2;
|
||
#elif(FREQ_SYS == 13000000)
|
||
i = (t * 13)>>2;
|
||
#elif(FREQ_SYS == 8000000)
|
||
i = t << 1;
|
||
#elif(FREQ_SYS == 4000000)
|
||
i = t;
|
||
#elif(FREQ_SYS == 2000000)
|
||
i = t >> 1;
|
||
#elif(FREQ_SYS == 1000000)
|
||
i = t >> 2;
|
||
#else
|
||
i = t;
|
||
#endif
|
||
|
||
#if((FREQ_SYS == 78000000)||\
|
||
(FREQ_SYS == 39000000)||\
|
||
(FREQ_SYS == 19500000))
|
||
while(--i)
|
||
{
|
||
__nop();
|
||
};
|
||
#else
|
||
do
|
||
{
|
||
__nop();
|
||
}while(--i);
|
||
#endif
|
||
}
|
||
|
||
/*********************************************************************
|
||
* @fn mDelaymS
|
||
*
|
||
* @brief mS 延时
|
||
*
|
||
* @param t - 时间参数
|
||
*
|
||
* @return none
|
||
*/
|
||
__HIGH_CODE
|
||
void mDelaymS(uint16_t t)
|
||
{
|
||
do
|
||
{
|
||
mDelayuS(1000);
|
||
}while(--t);
|
||
}
|
||
|
||
#ifdef DEBUG
|
||
int _write(int fd, char *buf, int size)
|
||
{
|
||
int i;
|
||
for(i = 0; i < size; i++)
|
||
{
|
||
#if DEBUG == Debug_UART0
|
||
while(R8_UART0_TFC == UART_FIFO_SIZE); /* 等待数据发送 */
|
||
R8_UART0_THR = *buf++; /* 发送数据 */
|
||
#elif DEBUG == Debug_UART1
|
||
while(R8_UART1_TFC == UART_FIFO_SIZE); /* 等待数据发送 */
|
||
R8_UART1_THR = *buf++; /* 发送数据 */
|
||
#elif DEBUG == Debug_UART2
|
||
while(R8_UART2_TFC == UART_FIFO_SIZE); /* 等待数据发送 */
|
||
R8_UART2_THR = *buf++; /* 发送数据 */
|
||
#elif DEBUG == Debug_UART3
|
||
while(R8_UART3_TFC == UART_FIFO_SIZE); /* 等待数据发送 */
|
||
R8_UART3_THR = *buf++; /* 发送数据 */
|
||
#endif
|
||
}
|
||
return size;
|
||
}
|
||
|
||
#endif
|
||
|
||
//int _write(int fd, char *buf, int size)
|
||
//{
|
||
// BSP_Uart3_Send_Data(buf, size);
|
||
// return size;
|
||
//}
|
||
|
||
/*********************************************************************
|
||
* @fn _sbrk
|
||
*
|
||
* @brief Change the spatial position of data segment.
|
||
*
|
||
* @return size: Data length
|
||
*/
|
||
__attribute__((used))
|
||
void *_sbrk(ptrdiff_t incr)
|
||
{
|
||
extern char _end[];
|
||
static char *curbrk = _end;
|
||
|
||
if ((curbrk + incr < _end) || ((uint32_t)curbrk + incr > (__get_SP() - 64)))
|
||
return NULL - 1;
|
||
|
||
curbrk += incr;
|
||
return curbrk - incr;
|
||
}
|
||
|
||
|