Re-add in simple scheduler for compatibility with legacy code, mark all scheduler...

[pub/lufa.git] / LUFA / Scheduler / Scheduler.c

diff --git a/LUFA/Scheduler/Scheduler.c b/LUFA/Scheduler/Scheduler.c
new file mode 100644 (file)
index 0000000..ff8946a
--- /dev/null
+++ b/LUFA/Scheduler/Scheduler.c
@@ -0,0 +1,95 @@
+/*\r
+             LUFA Library\r
+     Copyright (C) Dean Camera, 2009.\r
+              \r
+  dean [at] fourwalledcubicle [dot] com\r
+      www.fourwalledcubicle.com\r
+*/\r
+\r
+/*\r
+  Copyright 2009  Dean Camera (dean [at] fourwalledcubicle [dot] com)\r
+\r
+  Permission to use, copy, modify, and distribute this software\r
+  and its documentation for any purpose and without fee is hereby\r
+  granted, provided that the above copyright notice appear in all\r
+  copies and that both that the copyright notice and this\r
+  permission notice and warranty disclaimer appear in supporting\r
+  documentation, and that the name of the author not be used in\r
+  advertising or publicity pertaining to distribution of the\r
+  software without specific, written prior permission.\r
+\r
+  The author disclaim all warranties with regard to this\r
+  software, including all implied warranties of merchantability\r
+  and fitness.  In no event shall the author be liable for any\r
+  special, indirect or consequential damages or any damages\r
+  whatsoever resulting from loss of use, data or profits, whether\r
+  in an action of contract, negligence or other tortious action,\r
+  arising out of or in connection with the use or performance of\r
+  this software.\r
+*/\r
+\r
+#include "Scheduler.h"\r
+\r
+volatile SchedulerDelayCounter_t Scheduler_TickCounter;\r
+volatile uint8_t                 Scheduler_TotalTasks;\r
+\r
+bool Scheduler_HasDelayElapsed(const uint16_t Delay, SchedulerDelayCounter_t* const DelayCounter)\r
+{\r
+       SchedulerDelayCounter_t CurrentTickValue_LCL;\r
+       SchedulerDelayCounter_t DelayCounter_LCL;\r
+       \r
+       ATOMIC_BLOCK(ATOMIC_RESTORESTATE)\r
+       {\r
+               CurrentTickValue_LCL = Scheduler_TickCounter;\r
+       }\r
+       \r
+       DelayCounter_LCL = *DelayCounter;\r
+       \r
+       if (CurrentTickValue_LCL >= DelayCounter_LCL)\r
+       {\r
+               if ((CurrentTickValue_LCL - DelayCounter_LCL) >= Delay)\r
+               {\r
+                       *DelayCounter = CurrentTickValue_LCL;\r
+                       return true;\r
+               }\r
+       }\r
+       else\r
+       {\r
+               if (((MAX_DELAYCTR_COUNT - DelayCounter_LCL) + CurrentTickValue_LCL) >= Delay)\r
+               {\r
+                       *DelayCounter = CurrentTickValue_LCL;\r
+                       return true;\r
+               }       \r
+       }\r
+       \r
+       return false;\r
+}\r
+\r
+void Scheduler_SetTaskMode(const TaskPtr_t Task, const bool TaskStatus)\r
+{\r
+       TaskEntry_t* CurrTask = &Scheduler_TaskList[0];\r
+                                       \r
+       while (CurrTask != &Scheduler_TaskList[Scheduler_TotalTasks])\r
+       {\r
+               if (CurrTask->Task == Task)\r
+               {\r
+                       CurrTask->TaskStatus = TaskStatus;\r
+                       break;\r
+               }\r
+               \r
+               CurrTask++;\r
+       }\r
+}\r
+\r
+void Scheduler_SetGroupTaskMode(const uint8_t GroupID, const bool TaskStatus)\r
+{\r
+       TaskEntry_t* CurrTask = &Scheduler_TaskList[0];\r
+                                       \r
+       while (CurrTask != &Scheduler_TaskList[Scheduler_TotalTasks])\r
+       {\r
+               if (CurrTask->GroupID == GroupID)\r
+                 CurrTask->TaskStatus = TaskStatus;\r
+               \r
+               CurrTask++;\r
+       }\r
+}\r