Stabilus 322699 wDoublePID

Dependencies:   mbed QEI PID DmTftLibraryEx

Revision:
0:9c0917bfde97
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Peripherals/Timers.cpp	Mon Mar 13 15:12:05 2017 +0000
@@ -0,0 +1,56 @@
+/*
+  ______                              _
+ / _____)             _              | |
+( (____  _____ ____ _| |_ _____  ____| |__
+ \____ \| ___ |    (_   _) ___ |/ ___)  _ \
+ _____) ) ____| | | || |_| ____( (___| | | |
+(______/|_____)_|_|_| \__)_____)\____)_| |_|
+    (C)2016 Semtech
+
+Description: Timers
+
+Maintainer: Gregory Cristian & Gilbert Menth
+*/
+
+#include "mbed.h"
+#include "Timers.h"
+
+
+Ticker TickTimer;
+
+static uint32_t SoftTimer = 0;
+static void TimersIncSoftTimer( void );
+
+
+void TimersInit( void )
+{
+    TickTimer.attach_us( &TimersIncSoftTimer, 1000 ); // Ticks every millisecond
+}
+
+static void TimersIncSoftTimer( void )
+{
+    SoftTimer++;
+}
+
+void TimersSetTimer( uint32_t *sTimer, uint32_t timeLength )
+{
+    if( timeLength > MAX_TIMER_VALUE )
+    {
+        timeLength = MAX_TIMER_VALUE;
+    }
+    *sTimer = SoftTimer + timeLength;
+}
+
+uint32_t TimersTimerHasExpired ( const uint32_t * sTimer )
+{
+    if( ( SoftTimer - *sTimer ) > 0x7fffffff )
+    {
+        return false;
+    }
+    return true;
+}
+
+uint32_t TimersTimerValue ( void )
+{
+    return SoftTimer;
+}