Subversion Repositories shark

Rev

Rev 1624 | Blame | Compare with Previous | Last modification | View Log | RSS feed

/*
 * Project: S.Ha.R.K.
 *
 * Coordinators: Giorgio Buttazzo <giorgio@sssup.it>
 *
 * ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy)
 *
 * http://www.sssup.it
 * http://retis.sssup.it
 * http://shark.sssup.it
 */


#include "chimera.h"

struct action_event *first_action_event = NULL;
struct action_event *action_event_list;
int total_events = 0;

int get_free_slot();

int init_action_event(int number_of_events) {

  action_event_list = malloc(number_of_events * sizeof(struct action_event));
  memset(action_event_list,0,number_of_events * sizeof(struct action_event));
  total_events = number_of_events;

  if (action_event_list != NULL) return 0;

  total_events = 0;
  return -1;

}

int insert_action_event(struct action_event *e) {

  struct action_event *t = first_action_event, *k = NULL;
  int free;

  SYS_FLAGS f;

  f = kern_fsave();

  free = get_free_slot();

  if (free != -1) {
       
        memcpy(&(action_event_list[free]),e,sizeof(struct action_event));
        e = &(action_event_list[free]);

  } else {

        return -1;

  }

  e->status = EVT_STATUS_WAIT;

  if (!t) {
                                                                                                                             
        first_action_event = e;
        e->next = NULL;
        kern_frestore(f);
        return 0;
                                                                                                                             
  }

  while(t) {
        if (TIMESPEC_A_LT_B(&e->time,&t->time))
                break;
        k = t;
        t = t->next;
  }

  t = k->next;
  k->next = e;
  e->next = t;

  t = first_action_event;

  kern_frestore(f);

  return free;

}

int delete_action_event(int event) {
                                                                                                                             
  struct action_event *t = first_action_event;
  struct action_event *e = &(action_event_list[event]);
                                                                                                                             
  SYS_FLAGS f;
         
  if ((!t || !e) && (e->status != EVT_STATUS_FREE)) return -1;
                                                                                                                   
  f = kern_fsave();
                   
  if (t == e) {

        first_action_event = t->next;
        e->status = EVT_STATUS_FREE;
        kern_frestore(f);
        return 0;

  }
                                                                                                   
  while(t) {
        if (t->next == e)
                break;
        t = t->next;
  }
   
  if (t) {
        t->next = e->next;
        e->status = EVT_STATUS_FREE;
        kern_frestore(f);
        return 0;
  }        
                                                                                                                     
  kern_frestore(f);
                                                                                                                             
  return -1;
                                                                                                                             
}

int get_free_slot() {

  int k = 0;

  while (k < total_events) {

        if (action_event_list[k].status == EVT_STATUS_FREE ||
                action_event_list[k].status == EVT_STATUS_DONE)
                return k;
        k++;

  }

  return -1;

}

struct action_event * get_first_old_event(struct timespec *time) {

  struct action_event *t = first_action_event;
  SYS_FLAGS f;

  if (!t) return NULL;

  f = kern_fsave();

  if (TIMESPEC_A_GT_B(time,&(t->time))) {
    first_action_event = t->next;
    t->status = EVT_STATUS_EXEC;
    kern_frestore(f);
    return t;
  }

  kern_frestore(f);
  return NULL;

}