X-Git-Url: https://git.martlubbers.net/?a=blobdiff_plain;f=int%2Fnucleo-f767-blinky%2Fsrc%2Fsds.c;h=1300c0625f361db069e1897e295db66d9f8c2828;hb=0efbd98973520d55ec4e80e443911f43b3c28a0d;hp=6ac2d19d22283762cc6559f0fdb96f5c0bcde858;hpb=c0713ad3a24ba71c79dd55ed208fcb72ad6bee08;p=mTask.git

diff --git a/int/nucleo-f767-blinky/src/sds.c b/int/nucleo-f767-blinky/src/sds.c
index 6ac2d19..1300c06 100644
--- a/int/nucleo-f767-blinky/src/sds.c
+++ b/int/nucleo-f767-blinky/src/sds.c
@@ -1,14 +1,13 @@
 #include <stdlib.h>
 #include <string.h>
 
-#ifndef ARDUINO
+#ifndef STM32F767xx
 #include <unistd.h>
 #include <stdio.h>
 #endif
 
-#include "main.h"
+#include "interface.h"
 #include "interpret.h"
-#include "misc.h"
 #include "sds.h"
 
 struct sds sdss[MAXSDSS];
@@ -27,7 +26,7 @@ void sds_register()
 			break;
 
 	if(cs == MAXSDSS)
-		die("Trying to add too much tasks...\n");
+		die("Trying to add too much sdss...\n");
 
 	memset(&sdss[cs], 0, sizeof(struct sds));
 	//Read identifier
@@ -43,7 +42,7 @@ bool sds_update()
 {
 	uint8_t cs, id;
 	//Read identifier
-	id = read_byte();
+	id = read16();
 
 	for(cs = 0; cs<MAXSDSS; cs++){
 		if(!sdss[cs].used)
@@ -51,6 +50,10 @@ bool sds_update()
 		if(sdss[cs].id == id){
 			//Read value
 			sdss[cs].value = read16();
+			debug("\nReceived sds update %d: %d\n",
+			      sdss[cs].id, sdss[cs].value);
+			printf("\nReceived sds update %d: %d\n",
+			      sdss[cs].id, sdss[cs].value);
 			return true;
 		}
 	}