3 files changed, 29 insertions, 27 deletions

diff --git a/firmware/test/kernel/Makefile b/firmware/test/kernel/Makefile
index f632b3f6de..0740f6809c 100644
--- a/firmware/test/kernel/Makefile
+++ b/firmware/test/kernel/Makefile
@@ -14,7 +14,8 @@ TARGET = -DARCHOS_PLAYER_OLD=1
 CFLAGS = -g -O -Wall -m1 -save-temps -nostdlib -Wstrict-prototypes -fomit-frame-pointer -fschedule-insns -fno-builtin $(INCLUDES) $(TARGET)
 AFLAGS += -small -relax
 
-OBJS= ../../crt0.o ../../system.o main.o timer.o ../../thread.o ../../debug.o
+OBJS= ../../crt0.o ../../system.o main.o timer.o \
+        ../../thread.o ../../kernel.o ../../debug.o
 
 %.o: %.S
         $(CC) -o $@ $(CFLAGS) $(INCLUDES) $(DEFS) -c $<
diff --git a/firmware/test/kernel/main.c b/firmware/test/kernel/main.c
index 6ce99c8065..b52ecff21d 100644
--- a/firmware/test/kernel/main.c
+++ b/firmware/test/kernel/main.c
@@ -17,6 +17,7 @@
  *
  ****************************************************************************/
 #include "thread.h"
+#include "kernel.h"
 #include "sh7034.h"
 #include "debug.h"
 
@@ -30,11 +31,11 @@ void t2(void);
 
 int main(void)
 {
-   char buf[40];
-   char str[32];
-   int i=0;
+    char buf[40];
+    char str[32];
+    int i=0;
 
-   /* Clear it all! */
+    /* Clear it all! */
     SSR1 &= ~(SCI_RDRF | SCI_ORER | SCI_PER | SCI_FER);
 
     /* This enables the serial Rx interrupt, to be able to exit into the
@@ -46,31 +47,31 @@ int main(void)
     debugf("OK. Let's go\n");
 
     tick_start(40);
-    
+
     create_thread(t1, s1, 1024);
     create_thread(t2, s2, 1024);
 
     while(1)
     {
-       debugf("t0\n");
-       switch_thread();
+        debugf("t0\n");
+        sleep(100);
     }
 }
 
 void t1(void)
 {
-   while(1)
-   {
-      debugf("t1\n");
-      switch_thread();
-   }
+    while(1)
+    {
+        debugf("t1\n");
+        sleep(200);
+    }
 }
 
 void t2(void)
 {
-   while(1)
-   {
-      debugf("t2\n");
-      switch_thread();
-   }
+    while(1)
+    {
+        debugf("t2\n");
+        sleep(300);
+    }
 }
diff --git a/firmware/test/kernel/timer.c b/firmware/test/kernel/timer.c
index be253db2b5..31c6f82baa 100644
--- a/firmware/test/kernel/timer.c
+++ b/firmware/test/kernel/timer.c
@@ -19,6 +19,7 @@
 #include "sh7034.h"
 #include "system.h"
 #include "debug.h"
+#include "kernel.h"
 
 void tick_start(unsigned int interval_in_ms)
 {
@@ -26,6 +27,7 @@ void tick_start(unsigned int interval_in_ms)
 
     count = FREQ / 1000 / 8 * interval_in_ms;
 
+    debugf("count = %d\n", count);
     if(count > 0xffff)
     {
         debugf("Error! The tick interval is too long (%d ms)\n",
@@ -40,24 +42,22 @@ void tick_start(unsigned int interval_in_ms)
     TMDR &= ~0x01; /* Operate normally */
 
     TCNT0 = 0;   /* Start counting at 0 */
-    GRA0 = 0xfff0;
+    GRA0 = count;
     TCR0 = 0x23; /* Clear at GRA match, sysclock/8 */
 
-    TSTR |= 0x01; /* Start timer 1 */
-
     /* Enable interrupt on level 1 */
     IPRC = (IPRC & ~0x00f0) | 0x0010;
-
-    TIER0 |= 0x01; /* Enable GRA match interrupt */
     
-    while(1)
-    {
-    }
+    TSR0 &= ~0x01;
+    TIER0 |= 0x01; /* Enable GRA match interrupt */
+
+    TSTR |= 0x01; /* Start timer 1 */
 }
 
 #pragma interrupt
 void IMIA0(void)
 {
+    current_tick++;
+
     TSR0 &= ~0x01;
-    debugf("Yes\n");
 }