X-Git-Url: https://git.martlubbers.net/?a=blobdiff_plain;ds=sidebyside;f=int%2Finterface.c;h=962ce302e77ac6f355ea977240321dd6951a31cb;hb=525d00c72526e69f4b852178306bc7c34f6d1fcc;hp=e94f11c1337721a0571f12e97ee065271ac5beb0;hpb=64f379e7446a716257f6030157f2cb254200aa7b;p=mTask.git

diff --git a/int/interface.c b/int/interface.c
index e94f11c..962ce30 100644
--- a/int/interface.c
+++ b/int/interface.c
@@ -24,37 +24,31 @@ void write_byte(uint8_t b)
 	sdPut(&SD3, b);
 }
 
+uint64_t dpins[] = {LINE_ARD_D0, LINE_ARD_D1, LINE_ARD_D2, LINE_ARD_D3,
+	LINE_ARD_D4, LINE_ARD_D5, LINE_ARD_D6, LINE_ARD_D7, LINE_ARD_D8,
+	LINE_ARD_D9, LINE_ARD_D10, LINE_ARD_D11, LINE_ARD_D12, LINE_ARD_D13,
+	LINE_ARD_D14, LINE_ARD_D15};
 void write_dpin(uint8_t i, bool b)
 {
-	(void) i;
-	(void) 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);
 }
 
 bool read_dpin(uint8_t i)
 {
-	return 0;
-	(void) i;
+	if(i == 3){
+		return palReadLine(LINE_BUTTON) == PAL_HIGH;
+	}
+	return palReadLine(dpins[i]) == PAL_HIGH;
 }
 
 void write_apin(uint8_t i, uint8_t 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);
-		}
-	}
+	(void) i;
+	(void) a;
 }
 
 uint8_t read_apin(uint8_t i)
@@ -81,13 +75,13 @@ void setup(void)
 
 void debug(char *fmt, ...)
 {
+#ifdef DEBUG
 	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;
 }
@@ -99,5 +93,8 @@ void pdie(char *s)
 
 void die(char *fmt, ...)
 {
+	palWriteLine(LINE_LED1, PAL_HIGH);
+	palWriteLine(LINE_LED2, PAL_HIGH);
+	palWriteLine(LINE_LED3, PAL_HIGH);
 	(void)fmt;
 }