X-Git-Url: http://git.rot13.org/?p=goodfet;a=blobdiff_plain;f=firmware%2Fapps%2Fmonitor%2Fmonitor.c;fp=firmware%2Fapps%2Fmonitor%2Fmonitor.c;h=323691f3bb19d4fac12cc63f2ce1908837fc7d59;hp=33b31c7029b1fec5f6cb5373fbac50ace32b7930;hb=f2bee319a0c1b0a6c7618c02dbdfeacd68d5fea0;hpb=4de4683d6ed9abb3ce6eea37957f845d6d33243f

diff --git a/firmware/apps/monitor/monitor.c b/firmware/apps/monitor/monitor.c
index 33b31c7..323691f 100644
--- a/firmware/apps/monitor/monitor.c
+++ b/firmware/apps/monitor/monitor.c
@@ -9,9 +9,9 @@
 
 //! Call a function by address.
 int fncall(unsigned int adr){
-  //TODO replace this with portable C.
-  //Preprocessor definition might help.
-  __asm__("call r15"); //r12 on IAR
+  int (*machfn)() = 0;
+  machfn= (int (*)()) adr;
+  return machfn();
 }
 
 //! Handles a monitor command.
@@ -19,6 +19,9 @@ void monitorhandle(unsigned char app,
 		   unsigned char verb,
 		   unsigned long len){
   switch(verb){
+  default:
+    debugstr("ERROR: Command unsupported by debug monitor.");
+    break;
   case PEEK:
     cmddata[0]=memorybyte[cmddataword[0]];
     txdata(app,verb,1);