This commit is contained in:
stark1898y 2025-05-16 11:39:29 +08:00
parent 5ef5e9cd33
commit 2f9178215d
5 changed files with 134 additions and 123 deletions

View File

@ -223,7 +223,7 @@ __attribute__((noinline)) void Main_Circulation()
TMOS_SystemProcess(); TMOS_SystemProcess();
KEY_ProcessLoop(); KEY_ProcessLoop();
BSP_UART1_TxLoop(); BSP_UART1_TxLoop();
FEED_IWDG(); // FEED_IWDG();
} }
} }
@ -417,13 +417,10 @@ int main(void)
LED_ALL_OFF_DEINIT; LED_ALL_OFF_DEINIT;
BEEP_OFF_DEINIT; BEEP_OFF_DEINIT;
// logDebug("IWDG_Init 0");
// IWDG_Init(1500);
BSP_NoNeedBoost(); BSP_NoNeedBoost();
BSP_RequestSleep(); BSP_RequestSleep();
IWDG_Init(IWDG_MS); IWDG_Init(IWDG_TIMEOUT_MS);
// 在连接间隔和广播间隔到来时,会进入回调中喂狗 // 在连接间隔和广播间隔到来时,会进入回调中喂狗
// LL_AdvertiseEventRegister(BLE_AdvertiseEventCB); // LL_AdvertiseEventRegister(BLE_AdvertiseEventCB);

View File

@ -2,7 +2,7 @@
* @Author : stark1898y 1658608470@qq.com * @Author : stark1898y 1658608470@qq.com
* @Date : 2024-12-15 16:13:37 * @Date : 2024-12-15 16:13:37
* @LastEditors : stark1898y 1658608470@qq.com * @LastEditors : stark1898y 1658608470@qq.com
* @LastEditTime : 2025-04-13 22:48:38 * @LastEditTime : 2025-05-16 11:17:22
* @FilePath : \BLE_TYQ_CH584M\BSP\inc\bsp_iwdg.h * @FilePath : \BLE_TYQ_CH584M\BSP\inc\bsp_iwdg.h
* @Description : * @Description :
* *
@ -31,7 +31,8 @@
#define RB_WR_PROTECT 0x40000000 // RO, write protect #define RB_WR_PROTECT 0x40000000 // RO, write protect
#define RB_IWDG_EN 0x80000000 // RO, watch-dog enable #define RB_IWDG_EN 0x80000000 // RO, watch-dog enable
#define IWDG_MS (6000) #define IWDG_TIMEOUT_MS (7000U)
#define IWDG_FEED_MS (3000U)
#define IWIG_FEED_EVENT (0x01 << 0) #define IWIG_FEED_EVENT (0x01 << 0)

View File

@ -2,7 +2,7 @@
* @Author : stark1898y 1658608470@qq.com * @Author : stark1898y 1658608470@qq.com
* @Date : 2024-12-15 16:13:41 * @Date : 2024-12-15 16:13:41
* @LastEditors : stark1898y 1658608470@qq.com * @LastEditors : stark1898y 1658608470@qq.com
* @LastEditTime : 2025-05-15 18:34:10 * @LastEditTime : 2025-05-16 10:55:30
* @FilePath : \BLE_TYQ_CH584M\BSP\src\bsp_iwdg.c * @FilePath : \BLE_TYQ_CH584M\BSP\src\bsp_iwdg.c
* @Description : * @Description :
* *
@ -30,7 +30,7 @@ uint16_t IWDG_ProcessEvent(uint8_t task_id, uint16_t events)
{ {
FEED_IWDG(); FEED_IWDG();
logDebug("IWDG feed"); logDebug("IWDG feed");
tmos_start_task(task_id, IWIG_FEED_EVENT, 5000); tmos_start_task(task_id, IWIG_FEED_EVENT, MS1_TO_SYSTEM_TIME(IWDG_FEED_MS));
return (events ^ IWIG_FEED_EVENT); return (events ^ IWIG_FEED_EVENT);
} }
return 0; return 0;
@ -46,25 +46,28 @@ uint16_t IWDG_ProcessEvent(uint8_t task_id, uint16_t events)
void IWDG_Init(uint16_t ms) void IWDG_Init(uint16_t ms)
{ {
uint16_t div = 512; uint16_t div = 512;
float tick_ms = 1000 / (32000 / 512); // float tick_ms = 1000 / (32000 / 512);
uint8_t tick_ms = 16;
uint16_t reload = (ms / tick_ms) + 1; uint16_t reload = (ms / tick_ms) + 1;
// 解除IWDG保护 // 解除IWDG保护
R32_IWDG_KR = 0x5555; R32_IWDG_KR = 0x5555;
// R32_IWDG_CFG = (RB_PR & (div << 12)) | (RB_STOP_EN) | (reload & RB_RLR); R32_IWDG_CFG = (RB_PR & (div << 12)) | (RB_STOP_EN) | (reload & RB_RLR);
R32_IWDG_CFG |= (7 << 12); // 32K分频512时钟62.5Hz // R32_IWDG_CFG |= (7 << 12); // 32K分频512时钟62.5Hz
R32_IWDG_CFG &= 0xFFFFF000; // R32_IWDG_CFG &= 0xFFFFF000;
R32_IWDG_CFG |= 0x7D * 3; // 看门狗时间约256ms0x10/(32K/512)) // // R32_IWDG_CFG |= 0x7D * 3; // 看门狗时间约6 s0x10/(32K/512))
// R32_IWDG_CFG |= reload;
// 开启IWDG保护 // 开启IWDG保护
R32_IWDG_KR = 0xCCCC; R32_IWDG_KR = 0xCCCC;
logDebug("R32_IWDG_CFG = %X", R32_IWDG_CFG); logDebug("IWDG = %d, %.1f ms", reload, (reload * 1000) / 62.5);
IWDGTaskId = TMOS_ProcessEventRegister(IWDG_ProcessEvent); IWDGTaskId = TMOS_ProcessEventRegister(IWDG_ProcessEvent);
tmos_set_event(IWDGTaskId, IWIG_FEED_EVENT); // tmos_set_event(IWDGTaskId, IWIG_FEED_EVENT);
tmos_start_task(IWDGTaskId, IWIG_FEED_EVENT, MS1_TO_SYSTEM_TIME(IWDG_FEED_MS));
} }
// #define RB_RESET_FLAG 0x07 // RO: recent reset flag // #define RB_RESET_FLAG 0x07 // RO: recent reset flag

View File

@ -230,6 +230,19 @@ void HAL_Init()
{ {
halTaskID = TMOS_ProcessEventRegister(HAL_ProcessEvent); halTaskID = TMOS_ProcessEventRegister(HAL_ProcessEvent);
HAL_TimeInit(); HAL_TimeInit();
#if 0
// 开启独立看门狗会强制开启内部32K但是开启状态没有跟内部的RC32K寄存器同步
// 而复位时候是根据内部RC32K寄存器状态来决定是否启动RC32K
// 不关闭ch584的内部32KRC
sys_safe_access_enable();
R8_CK32K_CONFIG |= RB_CLK_INT32K_PON;
sys_safe_access_disable();
#endif
sys_safe_access_enable();
R8_SAFE_LRST_CTRL |= RB_IWDG_RST_EN;
sys_safe_access_disable();
#if(defined HAL_SLEEP) && (HAL_SLEEP == TRUE) #if(defined HAL_SLEEP) && (HAL_SLEEP == TRUE)
HAL_SleepInit(); HAL_SleepInit();
#endif #endif

View File

@ -34,28 +34,28 @@ void SetSysClock(SYS_CLKTypeDef sc)
R32_SAFE_MODE_CTRL |= RB_XROM_312M_SEL; R32_SAFE_MODE_CTRL |= RB_XROM_312M_SEL;
R8_SAFE_MODE_CTRL &= ~RB_SAFE_AUTO_EN; R8_SAFE_MODE_CTRL &= ~RB_SAFE_AUTO_EN;
sys_safe_access_enable(); sys_safe_access_enable();
if(sc == RB_CLK_SYS_MOD) // 32KHz if (sc == RB_CLK_SYS_MOD) // 32KHz
{ {
R16_CLK_SYS_CFG |= RB_CLK_SYS_MOD; R16_CLK_SYS_CFG |= RB_CLK_SYS_MOD;
} }
else else
{ {
if(sc & RB_OSC32M_SEL) if (sc & RB_OSC32M_SEL)
{ {
if(!(R8_HFCK_PWR_CTRL & RB_CLK_XT32M_PON)) if (!(R8_HFCK_PWR_CTRL & RB_CLK_XT32M_PON))
{ {
x32M_c = R8_XT32M_TUNE; x32M_c = R8_XT32M_TUNE;
R8_XT32M_TUNE |= 0x03; R8_XT32M_TUNE |= 0x03;
R8_HFCK_PWR_CTRL |= RB_CLK_XT32M_PON; R8_HFCK_PWR_CTRL |= RB_CLK_XT32M_PON;
clk_sys_cfg = R16_CLK_SYS_CFG; clk_sys_cfg = R16_CLK_SYS_CFG;
R16_CLK_SYS_CFG |= 0xC0; R16_CLK_SYS_CFG |= 0xC0;
for(i=0; i<9; i++) for (i = 0; i < 9; i++)
{ {
__nop(); __nop();
} }
R16_CLK_SYS_CFG = clk_sys_cfg; R16_CLK_SYS_CFG = clk_sys_cfg;
R8_XT32M_TUNE = x32M_c; R8_XT32M_TUNE = x32M_c;
} }
} }
else else
@ -63,50 +63,50 @@ void SetSysClock(SYS_CLKTypeDef sc)
R8_HFCK_PWR_CTRL |= RB_CLK_RC16M_PON; R8_HFCK_PWR_CTRL |= RB_CLK_RC16M_PON;
} }
if(sc & RB_XROM_SCLK_SEL) // PLL div if (sc & RB_XROM_SCLK_SEL) // PLL div
{ {
R8_HFCK_PWR_CTRL |= RB_CLK_PLL_PON; R8_HFCK_PWR_CTRL |= RB_CLK_PLL_PON;
if((sc&0x1F) == 0 ) if ((sc & 0x1F) == 0)
{ {
R8_FLASH_SCK = R8_FLASH_SCK|(1<<4); R8_FLASH_SCK = R8_FLASH_SCK | (1 << 4);
R8_FLASH_CFG = 0X07; R8_FLASH_CFG = 0X07;
} }
else if((sc&0x1F) < 10) else if ((sc & 0x1F) < 10)
{ {
R8_FLASH_SCK = R8_FLASH_SCK & (~(1<<4)); R8_FLASH_SCK = R8_FLASH_SCK & (~(1 << 4));
R8_FLASH_CFG = 0X01; R8_FLASH_CFG = 0X01;
} }
else if((sc&0x1F) < 16) else if ((sc & 0x1F) < 16)
{ {
R8_FLASH_SCK = R8_FLASH_SCK & (~(1<<4)); R8_FLASH_SCK = R8_FLASH_SCK & (~(1 << 4));
R8_FLASH_CFG = 0X02; R8_FLASH_CFG = 0X02;
} }
else else
{ {
R8_FLASH_SCK = R8_FLASH_SCK & (~(1<<4)); R8_FLASH_SCK = R8_FLASH_SCK & (~(1 << 4));
R8_FLASH_CFG = 0X07; R8_FLASH_CFG = 0X07;
} }
} }
else else
{ {
if((sc&0x1F) < 8 ) if ((sc & 0x1F) < 8)
{ {
R8_FLASH_SCK = R8_FLASH_SCK & (~(1<<4)); R8_FLASH_SCK = R8_FLASH_SCK & (~(1 << 4));
R8_FLASH_CFG = 0X51; R8_FLASH_CFG = 0X51;
} }
else else
{ {
R8_FLASH_SCK = R8_FLASH_SCK & (~(1<<4)); R8_FLASH_SCK = R8_FLASH_SCK & (~(1 << 4));
R8_FLASH_CFG = 0X57; R8_FLASH_CFG = 0X57;
} }
} }
R16_CLK_SYS_CFG = sc|0xC0; R16_CLK_SYS_CFG = sc | 0xC0;
R16_CLK_SYS_CFG = sc; R16_CLK_SYS_CFG = sc;
if(sc & RB_OSC32M_SEL) 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)) 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; R8_HFCK_PWR_CTRL &= ~RB_CLK_RC16M_PON;
} }
@ -115,7 +115,6 @@ void SetSysClock(SYS_CLKTypeDef sc)
{ {
R8_HFCK_PWR_CTRL &= ~RB_CLK_XT32M_PON; R8_HFCK_PWR_CTRL &= ~RB_CLK_XT32M_PON;
} }
} }
R8_SAFE_MODE_CTRL |= RB_SAFE_AUTO_EN; R8_SAFE_MODE_CTRL |= RB_SAFE_AUTO_EN;
sys_safe_access_disable(); sys_safe_access_disable();
@ -130,19 +129,18 @@ void SetSysClock(SYS_CLKTypeDef sc)
* *
* @return none * @return none
*/ */
__attribute__((section(".highcode_init"))) __attribute__((section(".highcode_init"))) void highcode_init(void)
void highcode_init(void)
{ {
R32_SAFE_MODE_CTRL |= RB_XROM_312M_SEL; R32_SAFE_MODE_CTRL |= RB_XROM_312M_SEL;
R8_SAFE_MODE_CTRL &= ~RB_SAFE_AUTO_EN; R8_SAFE_MODE_CTRL &= ~RB_SAFE_AUTO_EN;
sys_safe_access_enable(); sys_safe_access_enable();
R32_MISC_CTRL |= 5|(3<<25); // R32_MISC_CTRL |= 5 | (3 << 25); //
R8_PLL_CONFIG &= ~(1 << 5); // R8_PLL_CONFIG &= ~(1 << 5); //
R8_HFCK_PWR_CTRL |= RB_CLK_RC16M_PON | RB_CLK_PLL_PON; R8_HFCK_PWR_CTRL |= RB_CLK_RC16M_PON | RB_CLK_PLL_PON;
R16_CLK_SYS_CFG = CLK_SOURCE_HSI_PLL_62_4MHz; R16_CLK_SYS_CFG = CLK_SOURCE_HSI_PLL_62_4MHz;
R8_FLASH_SCK = R8_FLASH_SCK & (~(1<<4)); R8_FLASH_SCK = R8_FLASH_SCK & (~(1 << 4));
R8_FLASH_CFG = 0X02; R8_FLASH_CFG = 0X02;
R8_XT32M_TUNE = (R8_XT32M_TUNE&(~0x03))|0x01; R8_XT32M_TUNE = (R8_XT32M_TUNE & (~0x03)) | 0x01;
R8_CK32K_CONFIG |= RB_CLK_INT32K_PON; R8_CK32K_CONFIG |= RB_CLK_INT32K_PON;
R8_SAFE_MODE_CTRL |= RB_SAFE_AUTO_EN; R8_SAFE_MODE_CTRL |= RB_SAFE_AUTO_EN;
sys_safe_access_disable(); sys_safe_access_disable();
@ -161,7 +159,7 @@ __HIGH_CODE
__INTERRUPT __INTERRUPT
void MachineMode_Call_IRQ(void) void MachineMode_Call_IRQ(void)
{ {
if(gs_machine_mode_func != NULL) if (gs_machine_mode_func != NULL)
{ {
gs_machine_mode_func(); gs_machine_mode_func();
gs_machine_mode_func = NULL; gs_machine_mode_func = NULL;
@ -185,25 +183,25 @@ void MachineMode_Call(MachineMode_Call_func func)
uint32_t irqv; uint32_t irqv;
/* 这里关闭所有中断 */ /* 这里关闭所有中断 */
irqv = (PFIC->ISR[0] >> 8) | (PFIC->ISR[1] << 24); irqv = (PFIC->ISR[0] >> 8) | (PFIC->ISR[1] << 24);
PFIC->IRER[0] = 0xffffffff; PFIC->IRER[0] = 0xffffffff;
PFIC->IRER[1] = 0xffffffff; PFIC->IRER[1] = 0xffffffff;
/* 如果用户使用了SW中断的免表中断则需要取消此函数所有注释 */ /* 如果用户使用了SW中断的免表中断则需要取消此函数所有注释 */
// for(i = 0; i < 4; i++) // for(i = 0; i < 4; i++)
// { // {
// if(PFIC->VTFIDR[i] == SWI_IRQn) // if(PFIC->VTFIDR[i] == SWI_IRQn)
// { // {
// /* 找到了用户自己使用的SW中断关闭它 */ // /* 找到了用户自己使用的SW中断关闭它 */
// sw_vtf = PFIC->VTFADDR[i]; // sw_vtf = PFIC->VTFADDR[i];
// PFIC->VTFADDR[i] = (sw_vtf & 0xFFFFFFFE); // PFIC->VTFADDR[i] = (sw_vtf & 0xFFFFFFFE);
// break; // break;
// } // }
// } // }
sw_irqtable = _vector_base[SWI_IRQn]; sw_irqtable = _vector_base[SWI_IRQn];
_vector_base[SWI_IRQn] = (uint32_t)MachineMode_Call_IRQ; _vector_base[SWI_IRQn] = (uint32_t)MachineMode_Call_IRQ;
gs_machine_mode_func = func; gs_machine_mode_func = func;
/* 只打开SWI_IRQn */ /* 只打开SWI_IRQn */
PFIC_EnableIRQ(SWI_IRQn); PFIC_EnableIRQ(SWI_IRQn);
@ -211,17 +209,17 @@ void MachineMode_Call(MachineMode_Call_func func)
PFIC_SetPendingIRQ(SWI_IRQn); PFIC_SetPendingIRQ(SWI_IRQn);
/* 等待处理结束 */ /* 等待处理结束 */
while(gs_machine_mode_func != NULL); while (gs_machine_mode_func != NULL);
PFIC_DisableIRQ(SWI_IRQn); PFIC_DisableIRQ(SWI_IRQn);
_vector_base[SWI_IRQn] = sw_irqtable; _vector_base[SWI_IRQn] = sw_irqtable;
// if(i != 4) // if(i != 4)
// { // {
// /* 恢复原本的SW免表中断 */ // /* 恢复原本的SW免表中断 */
// PFIC->VTFADDR[i] = sw_vtf; // PFIC->VTFADDR[i] = sw_vtf;
// } // }
/* 这里恢复原来的中断使能配置 */ /* 这里恢复原来的中断使能配置 */
PFIC->IENR[0] = (irqv << 8); PFIC->IENR[0] = (irqv << 8);
@ -236,7 +234,8 @@ void MachineMode_Call(MachineMode_Call_func func)
* @param none * @param none
* *
* @return none * @return none
*/void SetPI_func() */
void SetPI_func()
{ {
write_csr(0xbc0, 0x25); write_csr(0xbc0, 0x25);
} }
@ -266,22 +265,22 @@ void SYS_EnablePI()
*/ */
uint32_t GetSysClock(void) uint32_t GetSysClock(void)
{ {
if((R16_CLK_SYS_CFG & RB_CLK_SYS_MOD) == RB_CLK_SYS_MOD) if ((R16_CLK_SYS_CFG & RB_CLK_SYS_MOD) == RB_CLK_SYS_MOD)
{ // 32K做主频 { // 32K做主频
return (CAB_LSIFQ); return (CAB_LSIFQ);
} }
else if(R16_CLK_SYS_CFG & RB_XROM_SCLK_SEL) else if (R16_CLK_SYS_CFG & RB_XROM_SCLK_SEL)
{ {
if(!(R16_CLK_SYS_CFG & 0x1f)) if (!(R16_CLK_SYS_CFG & 0x1f))
{ {
return ((R16_CLK_SYS_CFG & RB_OSC32M_SEL)?32000000:16000000); return ((R16_CLK_SYS_CFG & RB_OSC32M_SEL) ? 32000000 : 16000000);
} }
else else
{ // PLL进行分频 { // PLL进行分频
return (312000000 / (R16_CLK_SYS_CFG & 0x1f)); return (312000000 / (R16_CLK_SYS_CFG & 0x1f));
} }
} }
else if(R16_CLK_SYS_CFG & RB_OSC32M_SEL) else if (R16_CLK_SYS_CFG & RB_OSC32M_SEL)
{ // 32M进行分频 { // 32M进行分频
return (32000000 / (R16_CLK_SYS_CFG & 0x1f)); return (32000000 / (R16_CLK_SYS_CFG & 0x1f));
} }
@ -302,7 +301,7 @@ uint32_t GetSysClock(void)
*/ */
uint8_t SYS_GetInfoSta(SYS_InfoStaTypeDef i) uint8_t SYS_GetInfoSta(SYS_InfoStaTypeDef i)
{ {
if(i == STA_SAFEACC_ACT) if (i == STA_SAFEACC_ACT)
{ {
return (R8_SAFE_ACCESS_SIG & RB_SAFE_ACC_ACT); return (R8_SAFE_ACCESS_SIG & RB_SAFE_ACC_ACT);
} }
@ -342,7 +341,7 @@ void SYS_ResetExecute(void)
__HIGH_CODE __HIGH_CODE
void SYS_DisableAllIrq(uint32_t *pirqv) void SYS_DisableAllIrq(uint32_t *pirqv)
{ {
*pirqv = (PFIC->ISR[0] >> 8) | (PFIC->ISR[1] << 24); *pirqv = (PFIC->ISR[0] >> 8) | (PFIC->ISR[1] << 24);
PFIC->IRER[0] = 0xffffffff; PFIC->IRER[0] = 0xffffffff;
PFIC->IRER[1] = 0xffffffff; PFIC->IRER[1] = 0xffffffff;
asm volatile("fence.i"); asm volatile("fence.i");
@ -391,7 +390,7 @@ void WWDG_ITCfg(FunctionalState s)
{ {
uint8_t ctrl = R8_RST_WDOG_CTRL; uint8_t ctrl = R8_RST_WDOG_CTRL;
if(s == DISABLE) if (s == DISABLE)
{ {
ctrl &= ~RB_WDOG_INT_EN; ctrl &= ~RB_WDOG_INT_EN;
} }
@ -418,7 +417,7 @@ void WWDG_ResetCfg(FunctionalState s)
{ {
uint8_t ctrl = R8_RST_WDOG_CTRL; uint8_t ctrl = R8_RST_WDOG_CTRL;
if(s == DISABLE) if (s == DISABLE)
{ {
ctrl &= ~RB_WDOG_RST_EN; ctrl &= ~RB_WDOG_RST_EN;
} }
@ -459,19 +458,18 @@ void WWDG_ClearFlag(void)
*/ */
__INTERRUPT __INTERRUPT
__HIGH_CODE __HIGH_CODE
__attribute__((weak)) __attribute__((weak)) void HardFault_Handler(void)
void HardFault_Handler(void)
{ {
uint32_t v_mepc,v_mcause,v_mtval; uint32_t v_mepc, v_mcause, v_mtval;
printf("hardfault\n"); printf("hardfault\n");
v_mepc=__get_MEPC(); v_mepc = __get_MEPC();
v_mcause=__get_MCAUSE(); v_mcause = __get_MCAUSE();
v_mtval=__get_MTVAL(); v_mtval = __get_MTVAL();
printf("mepc:%08x\n",v_mepc); printf("mepc:%08x\n", v_mepc);
printf("mcause:%08x\n",v_mcause); printf("mcause:%08x\n", v_mcause);
printf("mtval:%08x\n",v_mtval); printf("mtval:%08x\n", v_mtval);
FLASH_ROM_SW_RESET(); FLASH_ROM_SW_RESET();
sys_safe_access_enable(); sys_safe_access_enable();
@ -480,7 +478,7 @@ void HardFault_Handler(void)
sys_safe_access_enable(); sys_safe_access_enable();
R8_RST_WDOG_CTRL |= RB_SOFTWARE_RESET; R8_RST_WDOG_CTRL |= RB_SOFTWARE_RESET;
sys_safe_access_disable(); sys_safe_access_disable();
while(1); while (1);
} }
/********************************************************************* /*********************************************************************
@ -496,42 +494,42 @@ __HIGH_CODE
void mDelayuS(uint16_t t) void mDelayuS(uint16_t t)
{ {
uint32_t i; uint32_t i;
#if(FREQ_SYS == 78000000) #if (FREQ_SYS == 78000000)
i = t * 13; i = t * 13;
#elif(FREQ_SYS == 62400000) #elif (FREQ_SYS == 62400000)
i = ((uint32_t)t * 78) / 5; i = ((uint32_t)t * 78) / 5;
#elif(FREQ_SYS == 52000000) #elif (FREQ_SYS == 52000000)
i = t * 13; i = t * 13;
#elif(FREQ_SYS == 39000000) #elif (FREQ_SYS == 39000000)
i = (t * 13)>>1; i = (t * 13) >> 1;
#elif(FREQ_SYS == 26000000) #elif (FREQ_SYS == 26000000)
i = (t * 13)>>1; i = (t * 13) >> 1;
#elif(FREQ_SYS == 24000000) #elif (FREQ_SYS == 24000000)
i = t * 6; i = t * 6;
#elif(FREQ_SYS == 19500000) #elif (FREQ_SYS == 19500000)
i = (t * 13)>>2; i = (t * 13) >> 2;
#elif(FREQ_SYS == 32000000) #elif (FREQ_SYS == 32000000)
i = t << 3; i = t << 3;
#elif(FREQ_SYS == 16000000) #elif (FREQ_SYS == 16000000)
i = t << 2; i = t << 2;
#elif(FREQ_SYS == 13000000) #elif (FREQ_SYS == 13000000)
i = (t * 13)>>2; i = (t * 13) >> 2;
#elif(FREQ_SYS == 8000000) #elif (FREQ_SYS == 8000000)
i = t << 1; i = t << 1;
#elif(FREQ_SYS == 4000000) #elif (FREQ_SYS == 4000000)
i = t; i = t;
#elif(FREQ_SYS == 2000000) #elif (FREQ_SYS == 2000000)
i = t >> 1; i = t >> 1;
#elif(FREQ_SYS == 1000000) #elif (FREQ_SYS == 1000000)
i = t >> 2; i = t >> 2;
#else #else
i = t; i = t;
#endif #endif
#if((FREQ_SYS == 78000000)||\ #if ((FREQ_SYS == 78000000) || \
(FREQ_SYS == 39000000)||\ (FREQ_SYS == 39000000) || \
(FREQ_SYS == 19500000)) (FREQ_SYS == 19500000))
while(--i) while (--i)
{ {
__nop(); __nop();
}; };
@ -539,7 +537,7 @@ void mDelayuS(uint16_t t)
do do
{ {
__nop(); __nop();
}while(--i); } while (--i);
#endif #endif
} }
@ -558,27 +556,27 @@ void mDelaymS(uint16_t t)
do do
{ {
mDelayuS(1000); mDelayuS(1000);
}while(--t); } while (--t);
} }
#ifdef DEBUG #ifdef DEBUG
int _write(int fd, char *buf, int size) int _write(int fd, char *buf, int size)
{ {
int i; int i;
for(i = 0; i < size; i++) for (i = 0; i < size; i++)
{ {
#if DEBUG == Debug_UART0 #if DEBUG == Debug_UART0
while(R8_UART0_TFC == UART_FIFO_SIZE); /* 等待数据发送 */ while (R8_UART0_TFC == UART_FIFO_SIZE); /* 等待数据发送 */
R8_UART0_THR = *buf++; /* 发送数据 */ R8_UART0_THR = *buf++; /* 发送数据 */
#elif DEBUG == Debug_UART1 #elif DEBUG == Debug_UART1
while(R8_UART1_TFC == UART_FIFO_SIZE); /* 等待数据发送 */ while (R8_UART1_TFC == UART_FIFO_SIZE); /* 等待数据发送 */
R8_UART1_THR = *buf++; /* 发送数据 */ R8_UART1_THR = *buf++; /* 发送数据 */
#elif DEBUG == Debug_UART2 #elif DEBUG == Debug_UART2
while(R8_UART2_TFC == UART_FIFO_SIZE); /* 等待数据发送 */ while (R8_UART2_TFC == UART_FIFO_SIZE); /* 等待数据发送 */
R8_UART2_THR = *buf++; /* 发送数据 */ R8_UART2_THR = *buf++; /* 发送数据 */
#elif DEBUG == Debug_UART3 #elif DEBUG == Debug_UART3
while(R8_UART3_TFC == UART_FIFO_SIZE); /* 等待数据发送 */ while (R8_UART3_TFC == UART_FIFO_SIZE); /* 等待数据发送 */
R8_UART3_THR = *buf++; /* 发送数据 */ R8_UART3_THR = *buf++; /* 发送数据 */
#endif #endif
} }
return size; return size;
@ -593,14 +591,13 @@ int _write(int fd, char *buf, int size)
* *
* @return size: Data length * @return size: Data length
*/ */
__attribute__((used)) __attribute__((used)) void *_sbrk(ptrdiff_t incr)
void *_sbrk(ptrdiff_t incr)
{ {
extern char _end[]; extern char _end[];
static char *curbrk = _end; static char *curbrk = _end;
if ((curbrk + incr < _end) || ((uint32_t)curbrk + incr > (__get_SP() - 64))) if ((curbrk + incr < _end) || ((uint32_t)curbrk + incr > (__get_SP() - 64)))
return NULL - 1; return NULL - 1;
curbrk += incr; curbrk += incr;
return curbrk - incr; return curbrk - incr;
@ -616,7 +613,7 @@ void *_sbrk(ptrdiff_t incr)
__HIGH_CODE __HIGH_CODE
void *__wrap_memcpy(void *dst, void *src, size_t size) void *__wrap_memcpy(void *dst, void *src, size_t size)
{ {
__MCPY(dst, src, (void *)((uint32_t)src+size)); __MCPY(dst, src, (void *)((uint32_t)src + size));
return dst; return dst;
} }
@ -661,7 +658,7 @@ void IWDG_RLR_Set(uint16_t rlr)
{ {
uint32_t cfg; uint32_t cfg;
cfg = R32_IWDG_CFG; cfg = R32_IWDG_CFG;
cfg = (R32_IWDG_CFG & ~0xFFF) | (rlr & 0xFFF); cfg = (R32_IWDG_CFG & ~0xFFF) | (rlr & 0xFFF);
R32_IWDG_CFG = cfg; R32_IWDG_CFG = cfg;
} }