You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
74 lines
1.4 KiB
74 lines
1.4 KiB
#include "dwt.h"
|
|
|
|
#include "../../MarlinCore.h"
|
|
#include "../../inc/MarlinConfig.h"
|
|
|
|
volatile uint32_t timeout;
|
|
|
|
/*
|
|
Счетчик за секунду "щелкает" SYS_CLK (72 000 000) раз.
|
|
DWT->CYCCNT 32-bit, 4294967295 / 72000000 = 59,6 секунд до переполнения
|
|
*/
|
|
|
|
|
|
void dwt_settimeout(uint32_t time){
|
|
|
|
if(time > (MAX_TIMEOUT-1)){
|
|
DEBUG("Timeout too much, reset to %d",MAX_TIMEOUT);
|
|
time = MAX_TIMEOUT;
|
|
}
|
|
|
|
//DEBUG("Set timeout %d %d",time, time * (SYS_CLK / 1000));
|
|
|
|
timeout = time * (SYS_CLK / 1000);
|
|
DWT->CYCCNT = 0;
|
|
}
|
|
|
|
uint32_t dwt_get_timeout(void){
|
|
volatile uint32_t current_timer = DWT->CYCCNT;
|
|
|
|
if(current_timer >= timeout) {
|
|
DEBUG("TO %d %d",current_timer,timeout);
|
|
timeout = 0;
|
|
return 0;
|
|
}
|
|
|
|
return 1;
|
|
}
|
|
|
|
|
|
void dwt_init(void){
|
|
|
|
CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
|
|
DWT->CYCCNT = 0;
|
|
DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;
|
|
|
|
}
|
|
|
|
|
|
uint32_t dwt_get_tick(void){
|
|
return DWT->CYCCNT;
|
|
}
|
|
|
|
uint32_t dwt_get_tick_in_sec(void){
|
|
return DWT->CYCCNT/(SYS_CLK/1000);
|
|
}
|
|
|
|
uint32_t dwt_get_diff_tick(uint32_t tick){
|
|
uint32_t result=0;
|
|
|
|
if(DWT->CYCCNT > tick){
|
|
result=DWT->CYCCNT-tick;
|
|
}else{
|
|
result=(uint32_t)(0xFFFFFFFF-tick)+DWT->CYCCNT;
|
|
};
|
|
|
|
return result;
|
|
}
|
|
|
|
uint32_t dwt_get_diff_sec(uint32_t tick){
|
|
|
|
return dwt_get_diff_tick(tick)/(SYS_CLK/1000);
|
|
}
|
|
|
|
|
|
|