WebSVN – freemyipod – Diff – /emcore/trunk/target/ipodnano2g/timer.c

 #include "timer.h"
 #include "thread.h"
 #include "s5l8701.h"
-void setup_tick()
+void timer_init()
+{
+}
+void timer_schedule_wakeup(uint32_t usecs)
+{
-    int cycles = SYSTEM_TICK / 100;
+    if (usecs > 11184640)
+    {
+        TBPRE = 511;
+        TBDATA1 = 65535;
+    }
-    /* configure timer for 10 kHz */
+    else if (usecs > 21845)
+    {
+        TBPRE = 511;
-    TBCMD = (1 << 1);   /* TB_CLR */
+        TBDATA1 = (usecs * 192) >> 15;
+    }
+    else
+    {
+        TBPRE = 0;
-    TBPRE = 300 - 1;    /* prescaler */
+        TBDATA1 = (usecs * 192) >> 6;
+    }
-    TBCON = (0 << 13) | /* TB_INT1_EN */
+    TBCON = (1 << 13) | /* TB_INT1_EN */
-            (1 << 12) | /* TB_INT0_EN */
+            (0 << 12) | /* TB_INT0_EN */
             (0 << 11) | /* TB_START */
             (2 << 8) |  /* TB_CS = PCLK / 16 */
-            (0 << 4);   /* TB_MODE_SEL = interval mode */
+            (2 << 4);   /* TB_MODE_SEL = one-shot mode */
-    TBDATA0 = cycles;   /* set interval period */
+    TBCMD = (1 << 1);   /* TB_CLR */
     TBCMD = (1 << 0);   /* TB_EN */
+}
+void timer_kill_wakeup()
+{
+    TBCMD = (1 << 1);   /* TB_CLR */
+    TBCON = TBCON;
+}
 void INT_TIMERB(void)
+{
     TBCON = TBCON;
     scheduler_switch(NULL, NULL);
+}

Subversion Repositories freemyipod