2021-09-10 05:19:02 +03:00
|
|
|
#pragma once
|
|
|
|
|
|
|
|
#include <stm32wbxx_ll_lptim.h>
|
|
|
|
#include <stm32wbxx_ll_bus.h>
|
2022-03-30 18:23:40 +03:00
|
|
|
#include <stm32wbxx_ll_rcc.h>
|
2021-09-10 05:19:02 +03:00
|
|
|
#include <stdint.h>
|
|
|
|
|
|
|
|
// Timer used for system ticks
|
2022-01-05 19:10:18 +03:00
|
|
|
#define FURI_HAL_OS_TIMER_MAX 0xFFFF
|
2021-09-10 05:19:02 +03:00
|
|
|
#define FURI_HAL_OS_TIMER_REG_LOAD_DLY 0x1
|
2022-01-05 19:10:18 +03:00
|
|
|
#define FURI_HAL_OS_TIMER LPTIM2
|
|
|
|
#define FURI_HAL_OS_TIMER_IRQ LPTIM2_IRQn
|
2021-09-10 05:19:02 +03:00
|
|
|
|
|
|
|
static inline void furi_hal_os_timer_init() {
|
|
|
|
// Configure clock source
|
|
|
|
LL_RCC_SetLPTIMClockSource(LL_RCC_LPTIM2_CLKSOURCE_LSE);
|
|
|
|
// Set interrupt priority and enable them
|
2022-01-05 19:10:18 +03:00
|
|
|
NVIC_SetPriority(
|
|
|
|
FURI_HAL_OS_TIMER_IRQ, NVIC_EncodePriority(NVIC_GetPriorityGrouping(), 15, 0));
|
2021-09-10 05:19:02 +03:00
|
|
|
NVIC_EnableIRQ(FURI_HAL_OS_TIMER_IRQ);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void furi_hal_os_timer_continuous(uint32_t count) {
|
2021-09-24 14:56:27 +03:00
|
|
|
count--;
|
2021-09-10 05:19:02 +03:00
|
|
|
// Enable timer
|
|
|
|
LL_LPTIM_Enable(FURI_HAL_OS_TIMER);
|
2022-01-05 19:10:18 +03:00
|
|
|
while(!LL_LPTIM_IsEnabled(FURI_HAL_OS_TIMER))
|
|
|
|
;
|
2021-09-10 05:19:02 +03:00
|
|
|
|
|
|
|
// Enable rutoreload match interrupt
|
|
|
|
LL_LPTIM_EnableIT_ARRM(FURI_HAL_OS_TIMER);
|
|
|
|
|
|
|
|
// Set autoreload and start counter
|
|
|
|
LL_LPTIM_SetAutoReload(FURI_HAL_OS_TIMER, count);
|
|
|
|
LL_LPTIM_StartCounter(FURI_HAL_OS_TIMER, LL_LPTIM_OPERATING_MODE_CONTINUOUS);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void furi_hal_os_timer_single(uint32_t count) {
|
2021-09-24 14:56:27 +03:00
|
|
|
count--;
|
2021-09-10 05:19:02 +03:00
|
|
|
// Enable timer
|
|
|
|
LL_LPTIM_Enable(FURI_HAL_OS_TIMER);
|
2022-01-05 19:10:18 +03:00
|
|
|
while(!LL_LPTIM_IsEnabled(FURI_HAL_OS_TIMER))
|
|
|
|
;
|
2021-09-10 05:19:02 +03:00
|
|
|
|
|
|
|
// Enable compare match interrupt
|
|
|
|
LL_LPTIM_EnableIT_CMPM(FURI_HAL_OS_TIMER);
|
|
|
|
|
|
|
|
// Set compare, autoreload and start counter
|
|
|
|
// Include some marging to workaround ARRM behaviour
|
2022-01-05 19:10:18 +03:00
|
|
|
LL_LPTIM_SetCompare(FURI_HAL_OS_TIMER, count - 3);
|
2021-09-10 05:19:02 +03:00
|
|
|
LL_LPTIM_SetAutoReload(FURI_HAL_OS_TIMER, count);
|
|
|
|
LL_LPTIM_StartCounter(FURI_HAL_OS_TIMER, LL_LPTIM_OPERATING_MODE_ONESHOT);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void furi_hal_os_timer_reset() {
|
|
|
|
// Hard reset timer
|
|
|
|
// THE ONLY RELIABLEWAY to stop it according to errata
|
|
|
|
LL_LPTIM_DeInit(FURI_HAL_OS_TIMER);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline uint32_t furi_hal_os_timer_get_cnt() {
|
|
|
|
uint32_t counter = LL_LPTIM_GetCounter(FURI_HAL_OS_TIMER);
|
|
|
|
uint32_t counter_shadow = LL_LPTIM_GetCounter(FURI_HAL_OS_TIMER);
|
|
|
|
while(counter != counter_shadow) {
|
|
|
|
counter = counter_shadow;
|
|
|
|
counter_shadow = LL_LPTIM_GetCounter(FURI_HAL_OS_TIMER);
|
|
|
|
}
|
|
|
|
return counter;
|
|
|
|
}
|