Ajout FishPeper

OpenSky/arch/stm32f1/hal_timeout.c

@@ -0,0 +1,95 @@
+/*
+    Copyright 2017 fishpepper <AT> gmail.com
+
+    This program is free software: you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation, either version 3 of the License, or
+    (at your option) any later version.
+
+    This program is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License
+    along with this program.  If not, see <http:// www.gnu.org/licenses/>.
+
+   author: fishpepper <AT> gmail.com
+*/
+
+#include "hal_timeout.h"
+#include "debug.h"
+#include "wdt.h"
+
+volatile static __IO uint32_t hal_timeout_100us;
+volatile static __IO uint32_t hal_timeout2_100us;
+volatile static __IO uint32_t hal_timeout_100us_delay;
+
+void hal_timeout_init(void) {
+    // configure 1ms sys tick:
+    if (SysTick_Config(SystemCoreClock / 10000)) {
+        debug("hal_timeout: failed to set systick timeout\n");
+    }
+
+    // set prio
+    NVIC_SetPriority(SysTick_IRQn, NVIC_PRIO_SYSTICK);
+
+    hal_timeout_100us = 0;
+    hal_timeout2_100us = 0;
+    hal_timeout_100us_delay = 0;
+}
+
+void hal_timeout_set_100us(__IO uint32_t hus) {
+    hal_timeout_100us = hus;
+}
+
+void hal_timeout2_set_100us(__IO uint32_t hus) {
+    hal_timeout2_100us = hus;
+}
+
+void hal_timeout_set(__IO uint32_t ms) {
+    hal_timeout_100us = 10*ms;
+}
+
+uint8_t hal_timeout_timed_out(void) {
+    // debug_put_uint16(hal_timeout_ms); debug("\n"); debug_flush();
+    return (hal_timeout_100us == 0);
+}
+
+uint8_t hal_timeout2_timed_out(void) {
+    // debug_put_uint16(hal_timeout_ms); debug("\n"); debug_flush();
+    return (hal_timeout2_100us == 0);
+}
+
+
+// seperate ms delay function
+void hal_timeout_delay_ms(uint32_t timeout) {
+    hal_timeout_100us_delay = 10*timeout;
+
+    while (hal_timeout_100us_delay > 0) {
+    }
+}
+
+/*// seperate ms delay function
+void hal_timeout_delay_100us(uint32_t timeout) {
+    hal_timeout_100us_delay = timeout;
+
+    while (hal_timeout_100us_delay > 0) {
+    }
+}*/
+
+void SysTick_Handler(void) {
+    if (hal_timeout_100us != 0) {
+        hal_timeout_100us--;
+    }
+    if (hal_timeout_100us_delay != 0) {
+        hal_timeout_100us_delay--;
+    }
+    if (hal_timeout2_100us != 0) {
+        hal_timeout2_100us--;
+    }
+}
+
+uint32_t hal_timeout_time_remaining(void) {
+    return hal_timeout_100us/10;
+}