558fa5670b
* RPC: Update protobuf sources * RPC: Add Virtual Display * Unify log tags * RPC: Virtual Display placeholder * Rpc: clear frame buffer callback before confirm. * Firmware: full assert for hal, move fatfs initialization to furi hal. * FuriHal: VCP optimizations, thread safe console. Rpc: adjust buffer sizes. Co-authored-by: Aleksandr Kutuzov <alleteam@gmail.com>
37 lines
870 B
C
37 lines
870 B
C
#include "furi-hal-delay.h"
|
|
|
|
#include <furi.h>
|
|
#include <cmsis_os2.h>
|
|
|
|
#define TAG "FuriHalDelay"
|
|
|
|
static uint32_t clk_per_microsecond;
|
|
|
|
void furi_hal_delay_init(void) {
|
|
CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
|
|
DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;
|
|
DWT->CYCCNT = 0U;
|
|
clk_per_microsecond = SystemCoreClock / 1000000.0f;
|
|
FURI_LOG_I(TAG, "Init OK");
|
|
}
|
|
|
|
void delay_us(float microseconds) {
|
|
uint32_t start = DWT->CYCCNT;
|
|
uint32_t time_ticks = microseconds * clk_per_microsecond;
|
|
while((DWT->CYCCNT - start) < time_ticks) {
|
|
};
|
|
}
|
|
|
|
// cannot be used in ISR
|
|
// TODO add delay_ISR variant
|
|
void delay(float milliseconds) {
|
|
uint32_t ticks = milliseconds / (1000.0f / osKernelGetTickFreq());
|
|
osStatus_t result = osDelay(ticks);
|
|
(void)result;
|
|
furi_assert(result == osOK);
|
|
}
|
|
|
|
uint32_t millis(void){
|
|
return HAL_GetTick();
|
|
}
|