fix

[mTask.git] / int / interface.c

diff --git a/int/interface.c b/int/interface.c
index 5c9b500..e94f11c 100644 (file)
--- a/int/interface.c
+++ b/int/interface.c
@@ -2,17 +2,16 @@
 #include <stdint.h>
 #include <stdlib.h>
 #include <string.h>
+#include <stdarg.h>
 
 #include "interface.h"
 #include "ch.h"
 #include "hal.h"
 
-//char buf[1024];
-
 //Globals
 bool input_available(void)
 {
-       return qSizeX(&(&SD3)->iqueue) > 0;
+       return iqGetFullI(&(&SD3)->iqueue)>0;
 }
 
 uint8_t read_byte(void)
@@ -39,8 +38,23 @@ bool read_dpin(uint8_t i)
 
 void write_apin(uint8_t i, uint8_t a)
 {
-       (void)i;
-       (void)a;
+       if(a){
+               if(i == 0){
+                       palSetLine(LINE_LED1);
+               } else if(i == 1){
+                       palSetLine(LINE_LED2);
+               } else if(i == 2){
+                       palSetLine(LINE_LED3);
+               }
+       } else {
+               if(i == 0){
+                       palClearLine(LINE_LED1);
+               } else if(i == 1){
+                       palClearLine(LINE_LED2);
+               } else if(i == 2){
+                       palClearLine(LINE_LED3);
+               }
+       }
 }
 
 uint8_t read_apin(uint8_t i)
@@ -65,6 +79,25 @@ void setup(void)
        sdStart(&SD3, NULL);
 }
 
-void test(void)
+void debug(char *fmt, ...)
+{
+       unsigned int i;
+       write_byte('m');
+       for(i = 0; i<strlen(fmt); i++){
+               write_byte((uint8_t)fmt[i]);
+       }
+       write_byte('\n');
+#ifdef DEBUG
+#endif
+       (void)fmt;
+}
+
+void pdie(char *s)
+{
+       (void)s;
+}
+
+void die(char *fmt, ...)
 {
+       (void)fmt;
 }