Cleaned up wirish/time, some interrupt handling refactoring:

Fixed millis(), it was just wrong, before.
Added micros(), not extensively tested.
New implementation of delayMicroseconds(). Should be more consistent
now.
Added a handful of nvic routines to enable/disable interrupts.
Cleaned up systick

1 files changed, 14 insertions, 39 deletions

diff --git a/wirish/time.c b/wirish/time.c
index 69e962c..c0fd03e 100644
--- a/wirish/time.c
+++ b/wirish/time.c
@@ -23,8 +23,6 @@
  * ****************************************************************************/
 
 /**
- *  @file time.c
- *
  *  @brief 
  */
 
@@ -32,46 +30,23 @@
 #include "systick.h"
 #include "time.h"
 
-#define CYCLES_PER_MICROSECOND  72
-#define FUDGE                   42
-
-extern volatile uint32 systick_timer_millis;
-
-uint32 millis() {
-   unsigned long m;
-   m = systick_timer_millis;
-   return m;
-}
-
 void delay(unsigned long ms)
 {
-   unsigned long start = millis();
-
-   while (millis() - start <= ms)
-      ;
+   uint32 i;
+   for (i = 0; i < ms; i++) {
+      delayMicroseconds(1000);
+   }
 }
 
-
-
-#if 1
 void delayMicroseconds(uint32 us) {
-    uint32 target;
-    uint32 last, cur, count;
-    /* fudge factor hacky hack hack for function overhead  */
-    target = us * CYCLES_PER_MICROSECOND - FUDGE;
-
-    /* Get current count */
-    last = systick_get_count();
-    cur = systick_get_count();
-    count = last;
-    while ((count-cur) <= target) {
-        cur = systick_get_count();
-
-        /* check for overflow  */
-        if (cur > last) {
-            count += MAPLE_RELOAD_VAL;
-        }
-        last = cur;
-    }
+    us *= 12;
+
+    /* fudge for function call overhead  */
+    us--;
+    asm volatile("   mov r0, %[us]          \n\t"
+                 "1: subs r0, #1            \n\t"
+                 "   bhi 1b                 \n\t"
+                 :
+                 : [us] "r" (us)
+                 : "r0");
 }
-#endif