update

[mTask.git] / client / interface.c

diff --git a/client/interface.c b/client/interface.c
index 0b994ea..59e750e 100644 (file)
--- a/client/interface.c
+++ b/client/interface.c
@@ -4,7 +4,6 @@
 #include <string.h>
 #include <stdarg.h>
 
-#include "chprintf.h"
 #include "interface.h"
 #include "ch.h"
 #include "hal.h"
@@ -12,17 +11,20 @@
 //Globals
 bool input_available(void)
 {
+       //return iqGetFullI(&(&SD6)->iqueue)>0;
        return iqGetFullI(&(&SD3)->iqueue)>0;
 }
 
 uint8_t read_byte(void)
 {
        return (uint8_t)sdGet(&SD3);
+       //return (uint8_t)sdGet(&SD6);
 }
 
 void write_byte(uint8_t b)
 {
        sdPut(&SD3, b);
+       //sdPut(&SD6, b);
 }
 
 uint64_t dpins[] = {LINE_ARD_D0, LINE_ARD_D1, LINE_ARD_D2, LINE_ARD_D3,
@@ -84,17 +86,23 @@ void delay(long ms)
 
 void setup(void)
 {
+       palSetPadMode(GPIOG, 9, PAL_MODE_ALTERNATE(8)); // USART6 TX
+       palSetPadMode(GPIOG, 14, PAL_MODE_ALTERNATE(8)); // USART6 RX
+
        halInit();
        chSysInit();
        sdStart(&SD3, NULL);
+//     sdStart(&SD6, NULL);
+
+//     while(1){
+//             sdPut(&SD3, sdGet(&SD6));
+//             delay(50);
+//     }
 }
 
 void debug(char *fmt, ...)
 {
-       va_list ap;
-       va_start(ap, fmt);
-       chvprintf((BaseSequentialStream *)&SD3, fmt, ap);
-       va_end(ap);
+       (void)fmt;
 }
 
 void pdie(char *s)