demo

[mTask.git] / int / interface.c

diff --git a/int/interface.c b/int/interface.c
index ba4446f..8106945 100644 (file)
--- a/int/interface.c
+++ b/int/interface.c
@@ -16,7 +16,7 @@ bool input_available(void)
 
 uint8_t read_byte(void)
 {
-       return sdGet(&SD3);
+       return (uint8_t)sdGet(&SD3);
 }
 
 void write_byte(uint8_t b)
@@ -30,10 +30,6 @@ uint64_t dpins[] = {LINE_ARD_D0, LINE_ARD_D1, LINE_ARD_D2, LINE_ARD_D3,
        LINE_ARD_D14, LINE_ARD_D15};
 void write_dpin(uint8_t i, bool b)
 {
-       if(i == 0){ palWriteLine(LINE_LED1, b ? PAL_HIGH : PAL_LOW);
-       } else if(i == 1){ palWriteLine(LINE_LED2, b ? PAL_HIGH : PAL_LOW);
-       } else if(i == 2){ palWriteLine(LINE_LED3, b ? PAL_HIGH : PAL_LOW);
-       }
        palWriteLine(dpins[i], b ? PAL_HIGH : PAL_LOW);
 }
 
@@ -57,6 +53,28 @@ uint8_t read_apin(uint8_t i)
        (void) i;
 }
 
+void led_on(uint8_t i)
+{
+       if(i == 0){
+               palWriteLine(LINE_LED1, PAL_HIGH);
+       } else if(i == 1){
+               palWriteLine(LINE_LED2, PAL_HIGH);
+       } else if(i == 2){
+               palWriteLine(LINE_LED3, PAL_HIGH);
+       }
+}
+
+void led_off(uint8_t i)
+{
+       if(i == 0){
+               palWriteLine(LINE_LED1, PAL_LOW);
+       } else if(i == 1){
+               palWriteLine(LINE_LED2, PAL_LOW);
+       } else if(i == 2){
+               palWriteLine(LINE_LED3, PAL_LOW);
+       }
+}
+
 long millis(void){
        return ST2MS(chVTGetSystemTime());
 }
@@ -75,23 +93,15 @@ void setup(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
+//     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;
 }
 
-void debugi(int i)
-{
-       char m[10];
-       debug(itoa(i, m, 10));
-}
-
 void pdie(char *s)
 {
        (void)s;