添加任务插槽,未写完

source/elec_det/elec_task_slot.c

@@ -0,0 +1,130 @@
+
+#include "elec_task_slot.h"
+#include "board.h"
+#include "stdlib.h"
+#include "string.h"
+
+
+
+/*
+
+此文件定义动态任务插入的机制
+
+*/
+
+
+#define ERR_TABLE_SIZE  10
+
+typedef struct _task_node{
+  task_def task;
+  struct _task_node *next;
+}task_node;
+
+
+
+
+typedef struct{
+  int node_num;
+  task_node *head;
+  task_node *current;
+  int err_num;
+  uint8_t err_table[ERR_TABLE_SIZE]
+}task_slot_def;
+
+
+
+void task_slot_delete(void)
+{
+  task_slot_def *t=app_variable("task_slot",0,0);
+  if(t){
+    task_node *n=t->head;
+    task_node *old=0;
+    while(n){
+      old=n;
+      n=n->next;
+      free(old);
+    }
+    free(t);
+  }
+}
+
+
+// 初始化
+void *task_slot_init(void)
+{
+  task_slot_def *t=app_variable("task_slot",0,0);
+  if(t==0){
+    t=calloc(1,sizeof(task_slot_def));
+    app_variable("task_slot",t,0);
+  }
+  return t;
+}
+
+
+
+// 添加一个任务
+int task_slot_add_item(void *context,task_def *item)
+{
+  task_slot_def *t=context;
+  if(t==0){
+    return -1;
+  }
+  task_node **n=&t->head;
+  task_node *tail;
+  tail=calloc(1,sizeof(task_node));
+  memcpy(tail,item,sizeof(task_node));
+  while(*n){
+    n=&(*n)->next;
+  }
+  (*n)=tail;
+  return 0;
+}
+
+
+
+
+// 找到下一个slot
+task_def *task_slot_next(void *context,uint8_t slot_index)
+{
+  task_slot_def *t=context;
+  if(t==0){
+    return 0;
+  }
+  task_node *n;
+  while(t->current){
+    n=t->current;
+    t->current=n->next;
+    if(n->task.slot_index==slot_index){
+      return &n->task;
+    }
+  }
+  return 0;
+}
+
+
+int task_slot_add_err(void *context,uint8_t err)
+{
+  task_slot_def *t=context;
+  if(t==0){
+    return -1;
+  }
+  int index=-1;
+  for(int i=0;i<ERR_TABLE_SIZE;i++){
+    if(t->err_table[i]==0){
+      if(index<0) index=i;
+    }
+    if(t->err_table[i]==err){
+      return;
+    }
+  }
+  if(index>=0){
+    t->err_table[index]=err;
+    t->err_num++;
+    return 0;
+  }
+  return -2;
+}
+
+
+
+