initial, ported from constantly failed C++ variant

src/PontCoopScheduler.c

@@ -0,0 +1,60 @@
+/*
+ * PontCoopScheduler.c
+ *
+ *  Created on: 29.08.2016
+ *      Author: wn
+ */
+
+
+#include <stdlib.h>
+
+#include "PontCoopScheduler.h"
+
+tTask tasks[MAX_NUM_OF_TASKS];
+
+
+void schInit() {
+	for (uint8_t i = 0; i < MAX_NUM_OF_TASKS; i++) {
+		tasks[i].delay = 0;
+		tasks[i].period = 0;
+		tasks[i].run = 0;
+		tasks[i].exec = NULL;
+	}
+}
+
+void schAdd(void (*exec)(void), uint32_t delay, uint32_t period) {
+	for (uint8_t i = 0; i < MAX_NUM_OF_TASKS; i++) {
+		if (tasks[i].exec == NULL) {
+			tasks[i].delay = delay;
+			tasks[i].period = period;
+			tasks[i].run = 0;
+			tasks[i].exec = exec;
+			break;
+		}
+	}
+}
+
+void schExec() {
+	for (uint8_t i = 0; i < MAX_NUM_OF_TASKS; i++) {
+		if (tasks[i].exec != NULL && tasks[i].run > 0) {
+			tasks[i].run--;
+			tasks[i].exec();
+			if (tasks[i].period == 0) {
+				tasks[i].exec = NULL;
+			}
+		}
+	}
+}
+
+void schUpdate() {
+	for (uint8_t i = 0; i < MAX_NUM_OF_TASKS; i++) {
+		if (tasks[i].exec != NULL) {
+			if (tasks[i].delay == 0) {
+				tasks[i].delay = tasks[i].period;
+				tasks[i].run++;
+			} else {
+				tasks[i].delay--;
+			}
+		}
+	}
+}