X-Git-Url: https://git.martlubbers.net/?a=blobdiff_plain;f=int%2Fnucleo-f767-blinky%2Fsrc%2Fmain.c;h=42c483e0b7b6d03aac0a751bed4ca331e7e097ad;hb=a5c6b47a3e645aa8ce326e00c80e8bf10d515215;hp=0be5c0f1a79b936c7382010d6f7b925974b52da9;hpb=0efbd98973520d55ec4e80e443911f43b3c28a0d;p=mTask.git

diff --git a/int/nucleo-f767-blinky/src/main.c b/int/nucleo-f767-blinky/src/main.c
index 0be5c0f..42c483e 100644
--- a/int/nucleo-f767-blinky/src/main.c
+++ b/int/nucleo-f767-blinky/src/main.c
@@ -32,30 +32,34 @@
 void read_message()
 {
 	//Find next task
-	uint8_t c = read_byte();
-	debug("Receiving input: %c\n", c);
-	switch(c){
-	case MSG_SDS_SPEC:
-		debug("Receiving an sds\n");
-		sds_register();
-		break;
-	case MSG_SDS_UPD:
-		debug("Receiving an sds\n");
-		//TODO do something with the return value
-		sds_update();
-		break;
-	case MSG_DEL_TASK:
-		debug("Receiving a delete task request\n");
-		task_delete();
-		break;
-	case MSG_GET_TASK:
-		debug("Receiving a task\n");
-		c = task_register();
-		break;
-	case '\n':
-		break;
-	default:
-		debug("Unknown message: %X\n", c);
+	if(input_available()){
+		uint8_t c = read_byte();
+		debug("Receiving input: %c\n", c);
+		switch(c){
+		case MSG_SDS_SPEC:
+			debug("Receiving an sds");
+			sds_register();
+			break;
+		case MSG_SDS_UPD:
+			debug("Receiving an sds");
+			//TODO do something with the return value
+			sds_update();
+			break;
+		case MSG_DEL_TASK:
+			debug("Receiving a delete task request");
+			task_delete();
+			break;
+		case MSG_GET_TASK:
+			debug("Receiving a task");
+			task_register();
+			break;
+		case '\0':
+			break;
+		case '\n':
+			break;
+		default:
+			debug("Unknown message: %X", c);
+		}
 	}
 }
 
@@ -65,8 +69,7 @@ void loop()
 	long cyclestart;
 	struct task *curtask;
 
-	if(input_available())
-		read_message();
+	read_message();
 
 	//Run tasks
 	cyclestart = millis();
@@ -81,7 +84,7 @@ void loop()
 //			debug("Task %d not scheduled\n", ct);
 			continue;
 		}
-		debug("Current task to run: %d\n", ct);
+		debug("Current task to run: %d", ct);
 		run_task(curtask);
 		curtask->lastrun = cyclestart;
 		write_byte('\n');
@@ -89,27 +92,40 @@ void loop()
 }
 
 #ifdef STM32F767xx
-char s[128] = "";
 int main1(void){
 #else
 int main(int argc, char *argv[]){
 	gargc = argc;
 	gargv = argv;
 #endif
-	debug("booting up\r\n");
 
 	//Initialize systems
 	setup();
 	sds_init();
 	task_init();
 
-	write_byte('\n');
+	//debug("booting up");
 
+	int i = 0;
 	while(true){
 		//Check for new tasks
-		debug("loop\r\n");
+//		debug("loop\r\n");
 		loop();
 		delay(100);
+		i = (i + 1) % 3;
+		if(i == 0){
+			SET_LED_RED;
+			RESET_LED_BLUE;
+			RESET_LED_GREEN;
+		} else if(i == 1){
+			RESET_LED_RED;
+			SET_LED_BLUE;
+			RESET_LED_GREEN;
+		} else if(i == 2){
+			RESET_LED_RED;
+			RESET_LED_BLUE;
+			SET_LED_GREEN;
+		}
 	}
 	return 0;
 }