misc/fsm/states.c

   1 #include "types.h"
   2 #include "states.h"
   3
   4 #include <stdio.h>
   5 #include <stdlib.h>
   6 #include <string.h>
   7
   8 /* Callback functions prototypes */
   9 static unsigned int state_hashf(const void *key);
  10 static int state_cmpf(const void *arg1, const void *arg2);
  11 static void state_printf(const void *key, const void *data);
  12
  13 stret_t state_init(state_t **state, size_t size, unsigned int factor)
  14 {
  15     /* Allocate memory state's event table */
  16     if ((*state = malloc(sizeof *state)) == NULL)
  17         return ST_NOMEM;
  18
  19     if (((*state)->evttable = malloc(sizeof *(*state)->evttable)) == NULL) {
  20         free(*state);
  21         return ST_NOMEM;
  22     }
  23
  24     if (htable_init((*state)->evttable, size, factor,
  25                     state_hashf, state_cmpf, state_printf) == HT_NOMEM) {
  26         free((*state)->evttable);
  27         free(*state);
  28         return ST_NOMEM;
  29     }
  30
  31     return ST_OK;
  32 }
  33
  34 stret_t state_add_evt(state_t *state, unsigned int key, const char *desc, void (*actionf)(void *data), state_t *newstate)
  35 {
  36     event_t *pevt;
  37     unsigned int *pkey;
  38
  39     /* Allocate memory for new key */
  40     if ((pkey = malloc(sizeof *pkey)) == NULL)
  41         return ST_NOMEM;
  42
  43     *pkey = key;
  44
  45     /* Allocate memory for new event */
  46     if ((pevt = malloc(sizeof *pevt)) == NULL) {
  47         free(pkey);
  48         return ST_NOMEM;
  49     }
  50
  51     /* Fill in structure's members */
  52     strncpy(pevt->evt_desc, desc, MAX_EVT_DESC);
  53     pevt->evt_actionf = actionf;
  54     pevt->evt_newstate = newstate;
  55
  56     /* Insert event to hash table */
  57     if (htable_insert(state->evttable, pkey, pevt) == HT_EXISTS) {
  58         free(pkey);
  59         free(pevt);
  60         return ST_EXISTS;
  61     }
  62
  63     return ST_OK;
  64 }
  65
  66 stret_t state_rem_evt(state_t *state, unsigned int key)
  67 {
  68     if (htable_free_obj(state->evttable, &key) == HT_NOTFOUND)
  69         return ST_NOTFOUND;
  70
  71     return ST_OK;
  72 }
  73
  74 stret_t state_free(state_t *state)
  75 {
  76     htable_free_all_obj(state->evttable, 2);
  77     htable_free(state->evttable);
  78     free(state->evttable);
  79     free(state);
  80
  81     return ST_OK;
  82 }
  83
  84 void state_print_evts(const state_t *state)
  85 {
  86     htable_print(state->evttable);
  87 }
  88
  89 /* Callback funtions */
  90 static unsigned int state_hashf(const void *key)
  91 {
  92     return *(const unsigned int *)key;
  93 }
  94
  95 static int state_cmpf(const void *arg1, const void *arg2)
  96 {
  97     unsigned int a = *(const unsigned int *)arg1;
  98     unsigned int b = *(const unsigned int *)arg2;
  99
 100     if (a > b)
 101         return -1;
 102     else if (a == b)
 103         return 0;
 104     else
 105         return 1;
 106 }
 107
 108 static void state_printf(const void *key, const void *data)
 109 {
 110     printf("key: %d\tdesc: %s ",
 111            *(const unsigned int *)key,
 112            ((const event_t *)data)->evt_desc);
 113 }