1 files changed, 69 insertions, 0 deletions
diff --git a/firmware/targets/f7/furi_hal/furi_hal_os_timer.h b/firmware/targets/f7/furi_hal/furi_hal_os_timer.h
new file mode 100644
index 00000000..6b26d337
--- /dev/null
+++ b/firmware/targets/f7/furi_hal/furi_hal_os_timer.h
@@ -0,0 +1,69 @@
+#pragma once
+
+#include <stm32wbxx_ll_lptim.h>
+#include <stm32wbxx_ll_bus.h>
+#include <stdint.h>
+
+// Timer used for system ticks
+#define FURI_HAL_OS_TIMER_MAX 0xFFFF
+#define FURI_HAL_OS_TIMER_REG_LOAD_DLY 0x1
+#define FURI_HAL_OS_TIMER LPTIM2
+#define FURI_HAL_OS_TIMER_IRQ LPTIM2_IRQn
+
+static inline void furi_hal_os_timer_init() {
+    // Configure clock source
+    LL_RCC_SetLPTIMClockSource(LL_RCC_LPTIM2_CLKSOURCE_LSE);
+    LL_APB1_GRP2_EnableClock(LL_APB1_GRP2_PERIPH_LPTIM2);
+    // Set interrupt priority and enable them
+    NVIC_SetPriority(
+        FURI_HAL_OS_TIMER_IRQ, NVIC_EncodePriority(NVIC_GetPriorityGrouping(), 15, 0));
+    NVIC_EnableIRQ(FURI_HAL_OS_TIMER_IRQ);
+}
+
+static inline void furi_hal_os_timer_continuous(uint32_t count) {
+    count--;
+    // Enable timer
+    LL_LPTIM_Enable(FURI_HAL_OS_TIMER);
+    while(!LL_LPTIM_IsEnabled(FURI_HAL_OS_TIMER))
+        ;
+
+    // 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) {
+    count--;
+    // Enable timer
+    LL_LPTIM_Enable(FURI_HAL_OS_TIMER);
+    while(!LL_LPTIM_IsEnabled(FURI_HAL_OS_TIMER))
+        ;
+
+    // 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
+    LL_LPTIM_SetCompare(FURI_HAL_OS_TIMER, count - 3);
+    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;
+}