df66f4f6ba
* Use SysTick as OS tick timer * Use LPTIM2 as tickless idle timer * Remove dummy LPTIM2 IRQ handler * Clean up clock init code * Rename os timer to idle timer * Advance hal ticks along with FreeRTOS's * Improve SysTick control during tickless idle * Improve idle timer precision * Correct SysTick IRQ priority * Main, FuriHal: move system startup to separate thread * Minor code cleanup Co-authored-by: Aleksandr Kutuzov <alleteam@gmail.com>
46 lines
1.2 KiB
C
46 lines
1.2 KiB
C
#include "furi_hal_delay.h"
|
|
|
|
#include <furi.h>
|
|
#include <cmsis_os2.h>
|
|
#include <stm32wbxx_ll_utils.h>
|
|
|
|
#define TAG "FuriHalDelay"
|
|
|
|
void furi_hal_delay_init() {
|
|
CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
|
|
DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;
|
|
DWT->CYCCNT = 0U;
|
|
}
|
|
|
|
uint32_t furi_hal_delay_instructions_per_microsecond() {
|
|
return SystemCoreClock / 1000000;
|
|
}
|
|
|
|
uint32_t furi_hal_get_tick(void) {
|
|
return osKernelGetTickCount();
|
|
}
|
|
|
|
uint32_t furi_hal_ms_to_ticks(float milliseconds) {
|
|
return milliseconds / (1000.0f / osKernelGetTickFreq());
|
|
}
|
|
|
|
void furi_hal_delay_us(float microseconds) {
|
|
uint32_t start = DWT->CYCCNT;
|
|
uint32_t time_ticks = microseconds * furi_hal_delay_instructions_per_microsecond();
|
|
while((DWT->CYCCNT - start) < time_ticks) {
|
|
};
|
|
}
|
|
|
|
// cannot be used in ISR
|
|
// TODO add delay_ISR variant
|
|
void furi_hal_delay_ms(float milliseconds) {
|
|
if(!FURI_IS_ISR() && osKernelGetState() == osKernelRunning) {
|
|
uint32_t ticks = milliseconds / (1000.0f / osKernelGetTickFreq());
|
|
osStatus_t result = osDelay(ticks);
|
|
(void)result;
|
|
furi_assert(result == osOK);
|
|
} else {
|
|
furi_hal_delay_us(milliseconds * 1000);
|
|
}
|
|
}
|