hopefully improved tcp and serial connection

[mTask.git] / client / interface.c

diff --git a/client/interface.c b/client/interface.c
index 8106945..0b994ea 100644 (file)
--- a/client/interface.c
+++ b/client/interface.c
@@ -4,6 +4,7 @@
 #include <string.h>
 #include <stdarg.h>
 
+#include "chprintf.h"
 #include "interface.h"
 #include "ch.h"
 #include "hal.h"
@@ -35,9 +36,6 @@ void write_dpin(uint8_t i, bool b)
 
 bool read_dpin(uint8_t i)
 {
-       if(i == 3){
-               return palReadLine(LINE_BUTTON) == PAL_HIGH;
-       }
        return palReadLine(dpins[i]) == PAL_HIGH;
 }
 
@@ -93,13 +91,10 @@ void setup(void)
 
 void debug(char *fmt, ...)
 {
-//     unsigned int i;
-//     write_byte((uint8_t)'m');
-//     for(i = 0; i<strlen(fmt); i++){
-//             write_byte((uint8_t)fmt[i]);
-//     }
-//     write_byte('\n');
-       (void)fmt;
+       va_list ap;
+       va_start(ap, fmt);
+       chvprintf((BaseSequentialStream *)&SD3, fmt, ap);
+       va_end(ap);
 }
 
 void pdie(char *s)