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 *pkey);
  10 static int state_cmpf(const void *parg1, const void *parg2);
  11 static void state_printf(const void *pkey, const void *pdata);
  12
  13 stret_t state_init(state_t **ppstate, size_t size, unsigned int factor)
  14 {
  15     /* Allocate memory state's event table */
  16     if ((*ppstate = malloc(sizeof **ppstate)) == NULL)
  17         return ST_NOMEM;
  18
  19     if (((*ppstate)->evttable = malloc(sizeof *(*ppstate)->evttable)) == NULL) {
  20         free(*ppstate);
  21         return ST_NOMEM;
  22     }
  23
  24     /* Initialize hash table that stores the events the state can process */
  25     if (htable_init((*ppstate)->evttable, size, factor,
  26                     state_hashf, state_cmpf, state_printf) == HT_NOMEM) {
  27         free((*ppstate)->evttable);
  28         free(*ppstate);
  29         return ST_NOMEM;
  30     }
  31
  32     /* Allocate memory for state's key */
  33     if (((*ppstate)->st_key = malloc(sizeof *(*ppstate)->st_key)) == NULL) {
  34         free((*ppstate)->evttable);
  35         free(*ppstate);
  36         return ST_NOMEM;
  37     }
  38
  39     /* Initialize flags */
  40     STATE_MARK_AS_UNREACHABLE(*ppstate);
  41
  42     return ST_OK;
  43 }
  44
  45 stret_t state_add_evt(state_t *pstate, unsigned int key, const char *pdesc,
  46                       void (*pactionf)(void *pdata), state_t *pnewstate)
  47 {
  48     event_t *pevt;
  49     unsigned int *pkey;
  50
  51     /* Allocate memory for new key */
  52     if ((pkey = malloc(sizeof *pkey)) == NULL)
  53         return ST_NOMEM;
  54
  55     *pkey = key;
  56
  57     /* Allocate memory for new event */
  58     if ((pevt = malloc(sizeof *pevt)) == NULL) {
  59         free(pkey);
  60         return ST_NOMEM;
  61     }
  62
  63     /* Fill in structure's members */
  64     strncpy(pevt->evt_desc, pdesc, MAX_EVT_DESC);
  65     pevt->evt_actionf = pactionf;
  66     pevt->evt_newstate = pnewstate;
  67
  68     /* Insert event to hash table */
  69     if (htable_insert(pstate->evttable, pkey, pevt) == HT_EXISTS) {
  70         free(pkey);
  71         free(pevt);
  72         return ST_EXISTS;
  73     }
  74
  75     return ST_OK;
  76 }
  77
  78 stret_t state_rem_evt(state_t *pstate, unsigned int key)
  79 {
  80     if (htable_free_obj(pstate->evttable, &key, HT_FREEKEY | HT_FREEDATA) == HT_NOTFOUND)
  81         return ST_NOTFOUND;
  82
  83     return ST_OK;
  84 }
  85
  86 unsigned int state_get_key(state_t *pstate)
  87 {
  88     return *pstate->st_key;
  89 }
  90
  91 stret_t state_free(state_t *pstate)
  92 {
  93     htable_free_all_obj(pstate->evttable, HT_FREEKEY | HT_FREEDATA);
  94     htable_free(pstate->evttable);
  95     free(pstate->evttable);
  96     free(pstate);
  97
  98     return ST_OK;
  99 }
 100
 101 void state_print_evts(const state_t *pstate, FILE *fp)
 102 {
 103     htable_print(pstate->evttable, fp);
 104 }
 105
 106 /* Callback funtions */
 107 static unsigned int state_hashf(const void *pkey)
 108 {
 109     return *(const unsigned int *) pkey;
 110 }
 111
 112 static int state_cmpf(const void *parg1, const void *parg2)
 113 {
 114     unsigned int a = *(const unsigned int *) parg1;
 115     unsigned int b = *(const unsigned int *) parg2;
 116
 117     if (a > b)
 118         return -1;
 119     else if (a == b)
 120         return 0;
 121     else
 122         return 1;
 123 }
 124
 125 static void state_printf(const void *pkey, const void *pdata)
 126 {
 127     const event_t *pevt;
 128
 129     pevt = (const event_t *) pdata;
 130     printf("evtkey: %u\tdesc: %s\tnewstate: %u",
 131            *(const unsigned int *) pkey,
 132            pevt->evt_desc,
 133            *(const unsigned int *) pevt->evt_newstate->st_key);
 134 }