More DS400 support

[fw/sdcc] / device / examples / ds400 / monitor400 / mon400.c

diff --git a/device/examples/ds400/monitor400/mon400.c b/device/examples/ds400/monitor400/mon400.c
index 478c592792d9f8134cf8f364870e2ac0f62e065a..5f39556e3d1e7d92ad4d6a35c0d118c21aa0bf8d 100644 (file)
--- a/device/examples/ds400/monitor400/mon400.c
+++ b/device/examples/ds400/monitor400/mon400.c
@@ -11,18 +11,59 @@ void usage(void)
     puts("Available commands:\n");
     puts("ledon: turns LED on.");
     puts("ledoff: turns LED off.");
-    puts("startclock: starts millisecond timer.");
     puts("clock: reports millisecond timer.");
     puts("sleep: sleeps for 10 seconds (or forever if you didn't startclock first).");
 }
 
+void blinker(void)
+{
+    int i, j;
+    
+    while (1)
+    {
+       P5 |= 4;
+       for (j = 0; j < 10; j++)
+       {
+           for (i = 0; i < 32767; i++)
+           {
+               ;
+           }
+       }
+       
+       P5 &= ~4;
+       
+       for (j = 0; j < 10; j++)
+       {
+           for (i = 0; i < 32767; i++)
+           {
+               ;
+           }
+       }       
+    }
+}
+
+
 void main(void)
 {
     char buffer[80];
     
     // At this stage, the rom isn't initalized. We do have polled serial I/O, though.
     printf("TINIm400 monitor rev 0.0\n");
-
+    
+    P5 |= 4; // LED off.
+    
+    // double the cpu speed.
+    if (1)
+    {
+       PMR = 0x82;
+       PMR = 0x92;
+       
+       while (!(EXIF & 8))
+           ;
+       
+       PMR = 0x12;
+    }
+    
     // Intialize the ROM.
     if (romInit(1))
     {
@@ -52,15 +93,14 @@ void main(void)
            P5 |= 4;
            printf("LED off.\n");
        }
-       else if (!strcmp(buffer, "startclock"))
-       {
-           printf("Starting clock...\n");
-           ClockInit();
-       }
        else if (!strcmp(buffer, "clock"))
        {
            printf("Clock: %ld\n", ClockTicks());
        }
+       else if (!strcmp(buffer, "thread"))
+       {
+           printf("Thread ID: %d\n", (int)DSS_getthreadID());
+       }
        else if (!strcmp(buffer, "sleep"))
        {
            printf("Sleeping for 10 seconds...\n");
@@ -69,7 +109,46 @@ void main(void)
            
            printf("Back.\n");
        }
-       
+       else if (!strcmp(buffer, "pmr"))
+       {
+           printf("PMR: %x\n", PMR);
+       }
+       else if (!strcmp(buffer, "exif"))
+       {
+           printf("EXIF: %x\n", EXIF);
+       }
+       else if (!strcmp(buffer, "blink"))
+       {
+           blinker();
+       }
+       else if (!strcmp(buffer, "t0"))
+       {
+           printf("TH0:TL0 %x:%x\n", TH0, TL0);
+       }
+       else if (!strcmp(buffer, "t2"))
+       {
+           printf("TH2:TL2 %x:%x\n", TH2, TH2);
+       }       
+       else if (!strcmp(buffer, "faster"))
+       {
+           printf("going really fast...\n");
+           P5 |= 4; // LED off.
+
+           PMR = 0x82; 
+           PMR = 0x8a; // 8a for REAL fast
+           PMR = 0x9a; // 9a for REAL fast.
+           
+           while (!(EXIF & 8))
+               ;
+
+           PMR = 0x1a; // 1a for REAL fast.
+           
+_asm
+               nop
+_endasm;               
+           
+           P5 &= ~5; // LED on.
+       }
        else if (buffer[0])
        {
            printf("Unknown command \"%s\".\n", buffer);