add external libraries and update stm version

[mTask.git] / int / nucleo-f767-blinky / src / sds.c

diff --git a/int/nucleo-f767-blinky/src/sds.c b/int/nucleo-f767-blinky/src/sds.c
index 4751284..1300c06 100644 (file)
--- a/int/nucleo-f767-blinky/src/sds.c
+++ b/int/nucleo-f767-blinky/src/sds.c
@@ -6,9 +6,8 @@
 #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;
                }
        }