From: Nathael Pajani <nathael.pajani@ed3l.fr>
Date: Sun, 6 Sep 2015 19:39:21 +0000 (+0200)
Subject: Time handling helpers improvements, still to be tested.
X-Git-Url: http://git.techno-innov.fr/?a=commitdiff_plain;h=192dbd49f05ae759955474154904e7f3f70d63dc;p=soft%2Flpc122x%2Fcore

Time handling helpers improvements, still to be tested.
---

diff --git a/include/lib/time.h b/include/lib/time.h
index 6f549ed..0921753 100644
--- a/include/lib/time.h
+++ b/include/lib/time.h
@@ -67,7 +67,8 @@ void time_to_buff_swapped(uint8_t* buf, struct time_spec* src_time);
 
 
 /* Get a snapshot of the time when this is called.
- * It is unsafe to call this one when in interrupt, use get_time_in_interrupt()
+ * When in interrupt, use get_time_in_interrupt(). It will get called anyway, but it
+ *   will be longer.
  */
 void get_time(struct time_spec* save_time);
 
@@ -76,10 +77,19 @@ void get_time(struct time_spec* save_time);
  */
 void get_time_in_interrupt(struct time_spec* save_time);
 
-/* Must be called once to register the systick callback. */
+
+/* Must be called once to register the systick callback.
+ * Can be called anytime, will just return if it has already been called.
+ */
 void time_init(void);
 
 
+/* Compute a time difference
+ * Return 0 if both times are the same, 1 if (t1 > t2), -1 if (t1 < t2)
+ */
+int get_time_diff(const struct time_spec* t1, const struct time_spec* t2, struct time_spec* diff);
+
+
 
 #endif /* LIB_TIME_H */
 
diff --git a/lib/time.c b/lib/time.c
index 053f8b5..3f2d262 100644
--- a/lib/time.c
+++ b/lib/time.c
@@ -135,6 +135,10 @@ void time_to_buff_swapped(uint8_t* buf, struct time_spec* src_time)
 void get_time(struct time_spec* save_time)
 {
 	/* FIXME : Check that we are not in interrupt ... */
+	if (get_priority_mask() == 0) {
+		get_time_in_interrupt(save_time);
+		return;
+	}
     /* We are not in interrupt context, we can wait for the lock to be released */
     while (sync_lock_test_and_set(&time_lock, 1) == 1) {};
 	save_time->seconds = time.seconds;
@@ -147,7 +151,7 @@ void get_time(struct time_spec* save_time)
  */
 void get_time_in_interrupt(struct time_spec* save_time)
 {
-    /* We are in interrupt context, we can wait for the lock to be released */
+    /* We are in interrupt context, we can't wait for the lock to be released */
 	save_time->seconds = time.seconds;
 	save_time->msec = time.msec;
 }
@@ -156,14 +160,48 @@ void get_time_in_interrupt(struct time_spec* save_time)
 static uint8_t time_configured = 0;
 void time_init(void)
 {
-    while (sync_lock_test_and_set(&time_lock, 1) == 1) {};
 	if (time_configured != 0) {
-    	sync_lock_release(&time_lock);
 		return;
 	}
 	time_configured = 1;
 	add_systick_callback(time_track, 1); /* callback, period (ms) */
-    sync_lock_release(&time_lock);
+}
+
+
+/* Compute a time difference
+ * Return 0 if both times are the same, 1 if (t1 > t2), -1 if (t1 < t2)
+ */
+int get_time_diff(const struct time_spec* t1, const struct time_spec* t2, struct time_spec* diff)
+{
+	if (t1->seconds < t2->seconds) {
+		diff->seconds = (t2->seconds - t1->seconds - 1);
+		diff->msec = ((t2->msec + 1000) - t1->msec);
+		if (diff->msec >= 1000) {
+			diff->msec -= 1000;
+			diff->seconds++;
+		}
+		return -1;
+	} else if (t1->seconds == t2->seconds) {
+		diff->seconds = 0;
+		if (t1->msec < t2->msec) {
+			diff->msec = t2->msec - t1->msec;
+			return -1;
+		} else if (t1->msec == t2->msec) {
+			diff->msec = 0;
+			return 0;
+		} else {
+			diff->msec = t1->msec - t2->msec;
+			return 1;
+		}
+	} else {
+		diff->seconds = (t1->seconds - t2->seconds - 1);
+		diff->msec = ((t1->msec + 1000) - t2->msec);
+		if (diff->msec >= 1000) {
+			diff->msec -= 1000;
+			diff->seconds++;
+		}
+		return 1;
+	}
 }