scheduler_add.c

   1 /*
   2  *  Copyright Droids Corporation, Microb Technology, Eirbot (2005)
   3  *
   4  *  This program is free software; you can redistribute it and/or modify
   5  *  it under the terms of the GNU General Public License as published by
   6  *  the Free Software Foundation; either version 2 of the License, or
   7  *  (at your option) any later version.
   8  *
   9  *  This program is distributed in the hope that it will be useful,
  10  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  *  GNU General Public License for more details.
  13  *
  14  *  You should have received a copy of the GNU General Public License
  15  *  along with this program; if not, write to the Free Software
  16  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  17  *
  18  *  Revision : $Id: scheduler_add.c,v 1.1.2.4 2009-11-08 17:33:14 zer0 Exp $
  19  *
  20  */
  21
  22 #include <aversive.h>
  23 #include <scheduler_config.h>
  24 #include <scheduler_private.h>
  25 #include <scheduler_stats.h>
  26
  27 /** get a free event, mark it as allocated and return its index, or -1
  28  *  if not found. */
  29 static inline int8_t
  30 scheduler_alloc_event(void)
  31 {
  32         uint8_t i;
  33         uint8_t flags;
  34
  35         for (i=0 ; i<SCHEDULER_NB_MAX_EVENT ; i++) {
  36                 IRQ_LOCK(flags);
  37                 if( g_tab_event[i].state == SCHEDULER_EVENT_FREE ) {
  38                         g_tab_event[i].state = SCHEDULER_EVENT_ALLOCATED;
  39                         IRQ_UNLOCK(flags);
  40                         return i;
  41                 }
  42                 IRQ_UNLOCK(flags);
  43         }
  44         SCHED_INC_STAT(alloc_fails);
  45         return -1;
  46 }
  47
  48
  49 /** Alloc an event, and fill its field, then mark it as active.
  50  *  return its index in the table, or -1 if no evt is available */
  51 int8_t
  52 scheduler_add_event(uint8_t unicity, void (*f)(void *),
  53                            void *data, uint16_t period,
  54                            uint8_t priority) {
  55         int8_t i;
  56         uint8_t flags;
  57
  58         if (period == 0)
  59                 return -1;
  60
  61         i = scheduler_alloc_event();
  62         if ( i == -1 )
  63                 return -1;
  64
  65         SCHED_INC_STAT(add_event);
  66
  67         if (!unicity)
  68                 g_tab_event[i].period = period ;
  69         else
  70                 g_tab_event[i].period = 0 ;
  71         g_tab_event[i].current_time = period ;
  72         g_tab_event[i].priority = priority ;
  73         g_tab_event[i].f = f;
  74         g_tab_event[i].data = data;
  75
  76         IRQ_LOCK(flags);
  77         g_tab_event[i].state = SCHEDULER_EVENT_ACTIVE;
  78         IRQ_UNLOCK(flags);
  79
  80         return i;
  81 }