From 32f3ef93e9041b4f912328bbf096fe1273a0624a Mon Sep 17 00:00:00 2001
From: Wolfgang Hottgenroth <wolfgang.hottgenroth@icloud.com>
Date: Sat, 24 Oct 2020 19:34:30 +0200
Subject: [PATCH] toggle loop

---
 cube/User/Src/main2.c | 17 +++++++++++++++--
 1 file changed, 15 insertions(+), 2 deletions(-)

diff --git a/cube/User/Src/main2.c b/cube/User/Src/main2.c
index 8b4da52..47218f1 100644
--- a/cube/User/Src/main2.c
+++ b/cube/User/Src/main2.c
@@ -1,5 +1,6 @@
 #include <string.h>
 #include <stdint.h>
+#include <stdbool.h>
 
 #include <PontCoopScheduler.h>
 #include <stdlib.h>
@@ -41,12 +42,24 @@ void disableLoop(void *handle) {
 	HAL_GPIO_WritePin(Loop_Disable_GPIO_Port, Loop_Disable_Pin, GPIO_PIN_RESET);
 }
 
+void toggleLoop(void *handle) {
+	static bool state = false;
+
+	if (state) {
+		disableLoop(NULL);
+	} else {
+		enableLoop(NULL);
+	}
+	state ^= true;
+}
+
 void my_setup_2() {
     schAdd(blinkRed, NULL, 0, 500);
 	schAdd(blinkGreen, NULL, 0, 1000);
 	schAdd(helloWorld, NULL, 0, 5000);
-	schAdd(enableLoop, NULL, 10000, 0);
-	schAdd(disableLoop, NULL, 20000, 0);
+	// schAdd(enableLoop, NULL, 10000, 0);
+	// schAdd(disableLoop, NULL, 20000, 0);
+	schAdd(toggleLoop, NULL, 0, 10000);
 }
 
 void my_loop() {