Add taskscheduler code

Author: origin2007

src/TaskScheduler/taskscheduler.cpp

@@ -0,0 +1,107 @@
+#include <MsTimer2.h>
+#include <taskscheduler.h>
+
+#define TIME_INTERVAL 1
+
+  sTask taskQueue[TASK_MAX];
+	unsigned int ticker;
+
+    void sch_init()
+    {
+      int i;
+      for(i=0; i<TASK_MAX; i++)
+      {
+        sch_deleteTask(i);
+      }
+      MsTimer2::set(TIME_INTERVAL, sch_update);
+	ticker = 0;
+    }
+
+    void sch_addTask(void (*pFun)(), long d, long p)
+    {
+      int i;
+      for(i=0; i<TASK_MAX; i++)
+      {
+        if(taskQueue[i].pTask == 0)
+        {
+         taskQueue[i].pTask = pFun;
+          taskQueue[i].delay = d;
+          taskQueue[i].peroid = p;
+          taskQueue[i].runme = 0;
+	  break;
+        }
+      }
+    }
+
+    void sch_start()
+    {
+	MsTimer2::start();
+    }
+
+    void sch_dispatchtasks()
+    {
+     int index;
+     for(index=0; index<TASK_MAX; index++)
+      {
+      if(taskQueue[index].runme>0)
+       {
+       (* taskQueue[index].pTask)();
+       taskQueue[index].runme = 0;
+
+       if(taskQueue[index].peroid==0)
+        {
+        sch_deleteTask(index);
+        }
+       }
+      } //run task
+    }
+
+  void sch_deleteTask(byte i)
+  {
+    if(taskQueue[i].pTask != 0)
+    {
+      taskQueue[i].pTask = 0;
+      taskQueue[i].delay = 0;
+      taskQueue[i].peroid = 0;
+      taskQueue[i].runme = 0;
+    }
+  }
+  
+    void sch_update()
+    {
+      int i;
+	ticker ++;
+      for(i=0; i<TASK_MAX; i++)
+      {
+        if(taskQueue[i].pTask != 0)
+        {
+          if(taskQueue[i].delay == 0)
+          {
+            taskQueue[i].runme = 1;
+            if(taskQueue[i].peroid > 0)
+            {
+              taskQueue[i].delay = taskQueue[i].peroid;
+            }
+          }
+          else{
+            taskQueue[i].delay -= 1;
+          }
+        }
+      }
+   }
+
+	unsigned int sch_getTicker()
+{
+	return ticker;
+}
+
+unsigned int sch_getQueueSize()
+{
+  int i;
+  int c = 0;
+  for(i=0; i<TASK_MAX; i++)
+  {
+    if(taskQueue[i].pTask != 0) c++;
+  }
+  return c;
+}

src/TaskScheduler/taskscheduler.h

@@ -0,0 +1,24 @@
+#ifndef taskschedular_h
+#define taskschedular_h
+
+#include "Arduino.h"
+
+#define TASK_MAX 10
+
+typedef struct {
+  void (*pTask)();
+  long delay;
+  long peroid;
+  byte runme;
+} sTask;
+
+
+  void sch_init(void);
+  void sch_addTask(void (*pFun)(), long delay, long peroid);
+  void sch_deleteTask(byte i);
+  void sch_start();
+  void sch_dispatchtasks();
+  void sch_update();
+  unsigned int sch_getTicker();
+  unsigned int sch_getQueueSize();
+#endif

src/TestTaskSchedular/TestTaskSchedular.ino

@@ -0,0 +1,31 @@
+#include <taskscheduler.h>
+
+void setup() {
+  Serial.begin(9600);
+  // put your setup code here, to run once:
+  pinMode(13, OUTPUT);
+  sch_init();
+  sch_addTask(do1, 0, 100);
+  sch_addTask(do2, 1, 100);
+  sch_start();
+}
+
+void loop() {
+  // put your main code here, to run repeatedly:
+  sch_dispatchtasks();
+  //Serial.print("+");
+}
+
+void do1()
+{
+  //Serial.print("+");
+  digitalWrite(13, HIGH);
+}
+
+void do2()
+{
+  //Serial.println(sch_getTicker());
+  //Serial.println(sch_getQueueSize());
+  digitalWrite(13, LOW);
+}
+