1 files changed, 88 insertions, 0 deletions
diff --git a/platform/atm2/ATM22xx-x1x/examples/HID_remote/src/atvrc/bridge_timer.c b/platform/atm2/ATM22xx-x1x/examples/HID_remote/src/atvrc/bridge_timer.c
new file mode 100644
index 0000000..0ce590b
--- /dev/null
+++ b/platform/atm2/ATM22xx-x1x/examples/HID_remote/src/atvrc/bridge_timer.c
@@ -0,0 +1,88 @@
+/**
+ *******************************************************************************
+ *
+ * @file bridge_timer.c
+ *
+ * @brief Bridge timer
+ *
+ * Copyright (C) Atmosic 2022
+ *
+ *******************************************************************************
+ */
+
+#include "arch.h"
+#include "atvrc_porting.h"
+#include "sw_timer.h"
+#pragma GCC diagnostic push
+#pragma GCC diagnostic ignored "-Wold-style-declaration"
+#include "vendor/common/blt_soft_timer.h"
+#pragma GCC diagnostic pop
+
+#define NUM_BLT_TIMER 3
+
+#undef TIMER_DEBUG
+
+#ifdef TIMER_DEBUG
+#define TIMER_TRACE DEBUG_TRACE
+#else
+#define TIMER_TRACE(fmt, ...) DEBUG_TRACE_COND(0, fmt, ##__VA_ARGS__)
+#endif
+
+typedef struct blt_sw_timer_t {
+    sw_timer_id_t tid;
+    blt_timer_callback_t func;
+} blt_sw_timer_t;
+
+static blt_sw_timer_t blt_sw_timer[NUM_BLT_TIMER];
+
+static void blt_sw_timer_timeout(sw_timer_id_t idx, void const *ctx)
+{
+    TIMER_TRACE("%s idx: %d", __func__, idx);
+    blt_timer_callback_t func = (blt_timer_callback_t)(uintptr_t)ctx;
+    if (func) {
+	func();
+    }
+}
+
+static uint8_t get_available_blt_sw_timer(void)
+{
+    for (uint8_t i = 0; i < NUM_BLT_TIMER; i++) {
+	if (!blt_sw_timer[i].tid) {
+	    return i;
+	}
+    }
+    DEBUG_TRACE("No available blt_sw_timer, increase NUM_BLT_TIMER");
+    ASSERT_ERR(0);
+    return 0;
+}
+
+int blt_soft_timer_add(blt_timer_callback_t func, u32 interval_us)
+{
+    uint8_t idx = get_available_blt_sw_timer();
+
+    blt_sw_timer[idx].tid = sw_timer_alloc(blt_sw_timer_timeout, func);
+    TIMER_TRACE("%s id: %d tid: %d inv: %lu func: %p", __func__, idx,
+	blt_sw_timer[idx].tid, interval_us, func);
+    blt_sw_timer[idx].func = func;
+#define USEC_TO_CSEC 10000
+    sw_timer_set(blt_sw_timer[idx].tid, interval_us / USEC_TO_CSEC);
+    return idx;
+}
+
+int blt_soft_timer_delete(blt_timer_callback_t func)
+{
+    uint8_t cnt = 0;
+    for (uint8_t i = 0; i < NUM_BLT_TIMER; i++) {
+	if (blt_sw_timer[i].func == func) {
+	    TIMER_TRACE("%s id: %d tid: %d cb: %p", __func__, i,
+		blt_sw_timer[i].tid, func);
+	    sw_timer_clear(blt_sw_timer[i].tid);
+	    sw_timer_free(blt_sw_timer[i].tid);
+	    blt_sw_timer[i].tid = 0;
+	    blt_sw_timer[i].func = NULL;
+	    cnt++;
+	}
+    }
+    TIMER_TRACE("found and deleted %d timer", cnt);
+    return cnt;
+}