util: 6809 bogomips

diff --git a/Applications/util/Makefile.6809 b/Applications/util/Makefile.6809
index 4620d2a..4b3c158 100644 (file)
--- a/Applications/util/Makefile.6809
+++ b/Applications/util/Makefile.6809
@@ -58,6 +58,7 @@ SRCSNS = \
 SRCS  = \
        banner.c \
        bd.c \
+       bogomips.c \
        cal.c \
        cksum.c \
        cut.c \

diff --git a/Applications/util/bogomips.c b/Applications/util/bogomips.c
index a7440d0..527bc75 100644 (file)
--- a/Applications/util/bogomips.c
+++ b/Applications/util/bogomips.c
@@ -3,7 +3,24 @@
 #include <sys/types.h>
 #include <sys/time.h>
 
-#ifdef __SDCC_z80
+#if defined(__m6809__) && defined(__GNUC__)
+
+__attribute__((naked))
+void delay(unsigned long r)
+{
+    asm(
+       " ldd 4,s     \n"
+       " ldx 2,s     \n"
+        "a@ addd #-1  \n"   
+       " bne a@      \n"  
+       " leax  ,x    \n"
+       " beq b@      \n"
+       " leax -1,x   \n"   
+       " bra a@      \n"   
+       "b@ rts       \n"
+       );
+}
+#elif defined(__SDCC_z80)
 void delay(unsigned long r)
 {
 __asm