uff -- resolved hardware race conditions (hopefully)

[tinyos-2.x.git] / tos / platforms / eyesIFX / LocalTimeP.nc

diff --git a/tos/platforms/eyesIFX/LocalTimeP.nc b/tos/platforms/eyesIFX/LocalTimeP.nc
index 87784227ceca7a2cbf438a64efbbfaa4539175c0..d696ad0d959eda4009942e2f7e43821c05031a12 100644 (file)
--- a/tos/platforms/eyesIFX/LocalTimeP.nc
+++ b/tos/platforms/eyesIFX/LocalTimeP.nc
@@ -30,35 +30,58 @@
 module LocalTimeP {
     provides {  
         interface LocalTime<T32khz> as LocalTime32kHz;
+        interface WideLocalTime<T32khz> as WideLocalTime;
     }
     uses {
         interface Counter<T32khz,uint16_t> as Counter32khz16;
     }
 }
 implementation  {
-    typedef union 
-    {
-        uint32_t op;
-        struct {
-            uint16_t lo;
-            uint16_t hi;
-        };
-    } ui32parts_t;
-    
-    uint16_t counter2sec = 127;
-
+    uint16_t counter2sec = 40000U;
+    int32_t dayCounter = 0;
+    bool increaseDay = FALSE;
     async command uint32_t LocalTime32kHz.get() {
-        ui32parts_t time;
+        int64_t time;
+        unsigned t;
+        bool dirty1;
+        bool dirty2;
         atomic {
-            time.lo = call Counter32khz16.get();
-            time.hi = counter2sec;
-            if(call Counter32khz16.isOverflowPending()) ++time.hi;
+            increaseDay = FALSE;
+            do {
+                dirty1 = call Counter32khz16.isOverflowPending();
+                t = call Counter32khz16.get();
+                dirty2 = call Counter32khz16.isOverflowPending();
+            } while (dirty1 != dirty2);
+            time = counter2sec;
+            if(dirty1) {
+                ++time;
+                if(time == 0) {
+                    increaseDay = TRUE;
+                }
+            }
+            time = (time << 16) + t;
         }
-        return time.op;
+        return time;
     }
 
+    async command int64_t WideLocalTime.get() {
+        int64_t time;
+        uint32_t t;
+        atomic {
+            t = call LocalTime32kHz.get();
+            time = dayCounter;
+            if(increaseDay) time++;
+            if(time < 0) time = 0;
+            time <<= 32;
+            time += t;
+        }
+        return time;
+    }
+    
     async event void Counter32khz16.overflow() {
         ++counter2sec;
+        if(counter2sec == 0) ++dayCounter;
+        if(dayCounter < 0) dayCounter = 0;
     }
 }