X-Git-Url: https://git.martlubbers.net/?a=blobdiff_plain;f=int%2Finterface.c;h=810694526ade5023cf51e8f6b90eb0c5a2f557f1;hb=f90517d738696125a067f113edf93f404873115b;hp=ba4446f92d087dd7c88ced1782df3c00ede0782e;hpb=8449be73c124cdccd37500c0d67d9404b94fc9c8;p=mTask.git diff --git a/int/interface.c b/int/interface.c index ba4446f..8106945 100644 --- 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