xyControl  0.1
Quadrotor Flight Controller on AVR Basis
 All Data Structures Files Functions Variables Typedefs Enumerations Enumerator Groups
tasks.c
Go to the documentation of this file.
1 /*
2  * tasks.c
3  *
4  * Copyright (c) 2013, Thomas Buck <xythobuz@me.com>
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  *
11  * - Redistributions of source code must retain the above copyright notice,
12  * this list of conditions and the following disclaimer.
13  *
14  * - Redistributions in binary form must reproduce the above copyright
15  * notice, this list of conditions and the following disclaimer in the
16  * documentation and/or other materials provided with the distribution.
17  *
18  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
19  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
20  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
21  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
22  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
23  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
24  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
25  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
26  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
27  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
28  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29  */
30 #include <stdlib.h>
31 #include <stdint.h>
32 
33 #include <xmem.h>
34 #include <tasks.h>
35 
47 uint8_t tasksRegistered(void) {
48  uint8_t c = 0;
50  for (TaskElement *p = taskList; p != NULL; p = p->next) {
51  c++;
52  }
54  return c;
55 }
56 
57 uint8_t addTask(Task func) {
59  TaskElement *p = (TaskElement *)malloc(sizeof(TaskElement));
60  if (p == NULL) {
62  return 1;
63  }
64  p->task = func;
65  p->next = taskList;
66  taskList = p;
68  return 0;
69 }
70 
71 uint8_t removeTask(Task func) {
73  TaskElement *p = taskList;
74  TaskElement *prev = NULL;
75  while (p != NULL) {
76  if (p->task == func) {
77  if (prev == NULL) {
78  taskList = p->next;
79  } else {
80  prev->next = p->next;
81  }
82  free(p);
84  return 0;
85  }
86  prev = p;
87  p = p->next;
88  }
90  return 1;
91 }
92 
93 void tasks(void) {
95  static TaskElement *p = NULL;
96  if (p == NULL) {
97  p = taskList;
98  }
99  if (p != NULL) {
100  p->task();
101  p = p->next;
102  }
104 }