X-Git-Url: https://git.martlubbers.net/?a=blobdiff_plain;f=client%2Finterface.c;h=8afac28a9490dfc45e9807f3388d25132c0bebc5;hb=c518754bec4758cce7d899463f9c68612c3bf4e4;hp=0b994eab07f587b80dc61835b8cef96512c4eb49;hpb=639cdcf1c26177c87237bd5790e89184f531731d;p=mTask.git

diff --git a/client/interface.c b/client/interface.c
index 0b994ea..8afac28 100644
--- 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,6 +86,9 @@ 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);
@@ -91,10 +96,12 @@ void setup(void)
 
 void debug(char *fmt, ...)
 {
-	va_list ap;
-	va_start(ap, fmt);
-	chvprintf((BaseSequentialStream *)&SD3, fmt, ap);
-	va_end(ap);
+	write_byte('m');
+	for(unsigned int i = 0; i<strlen(fmt); i++){
+		write_byte(fmt[i]);
+	}
+	write_byte('\n');
+//	(void)fmt;
 }
 
 void pdie(char *s)