JTAG430X2 works at 16MHz, not at 3MHz.

[goodfet] / firmware / lib / command.c

diff --git a/firmware/lib/command.c b/firmware/lib/command.c
index 08a5cf7..f585e4c 100644 (file)
--- a/firmware/lib/command.c
+++ b/firmware/lib/command.c
@@ -36,3 +36,13 @@ void delay(unsigned int count){
   volatile unsigned int i=count;
   while(i--) asm("nop");
 }
+//! MSDelay
+void msdelay(unsigned int ms){
+  volatile unsigned int i,j;
+  i=100;
+  while(i--){
+    j=ms;
+    while(j--) asm("nop");
+  }
+  //Using TimerA might be cleaner.
+}