267 lines
6.3 KiB
C
267 lines
6.3 KiB
C
|
/* SPDX-License-Identifier: GPL-2.0 */
|
||
|
#ifndef _FSM_H_
|
||
|
#define _FSM_H_
|
||
|
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/types.h>
|
||
|
#include <linux/timer.h>
|
||
|
#include <linux/time.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <linux/sched.h>
|
||
|
#include <linux/string.h>
|
||
|
#include <linux/atomic.h>
|
||
|
|
||
|
/**
|
||
|
* Define this to get debugging messages.
|
||
|
*/
|
||
|
#define FSM_DEBUG 0
|
||
|
|
||
|
/**
|
||
|
* Define this to get debugging massages for
|
||
|
* timer handling.
|
||
|
*/
|
||
|
#define FSM_TIMER_DEBUG 0
|
||
|
|
||
|
/**
|
||
|
* Define these to record a history of
|
||
|
* Events/Statechanges and print it if a
|
||
|
* action_function is not found.
|
||
|
*/
|
||
|
#define FSM_DEBUG_HISTORY 0
|
||
|
#define FSM_HISTORY_SIZE 40
|
||
|
|
||
|
struct fsm_instance_t;
|
||
|
|
||
|
/**
|
||
|
* Definition of an action function, called by a FSM
|
||
|
*/
|
||
|
typedef void (*fsm_function_t)(struct fsm_instance_t *, int, void *);
|
||
|
|
||
|
/**
|
||
|
* Internal jump table for a FSM
|
||
|
*/
|
||
|
typedef struct {
|
||
|
fsm_function_t *jumpmatrix;
|
||
|
int nr_events;
|
||
|
int nr_states;
|
||
|
const char **event_names;
|
||
|
const char **state_names;
|
||
|
} fsm;
|
||
|
|
||
|
#if FSM_DEBUG_HISTORY
|
||
|
/**
|
||
|
* Element of State/Event history used for debugging.
|
||
|
*/
|
||
|
typedef struct {
|
||
|
int state;
|
||
|
int event;
|
||
|
} fsm_history;
|
||
|
#endif
|
||
|
|
||
|
/**
|
||
|
* Representation of a FSM
|
||
|
*/
|
||
|
typedef struct fsm_instance_t {
|
||
|
fsm *f;
|
||
|
atomic_t state;
|
||
|
char name[16];
|
||
|
void *userdata;
|
||
|
int userint;
|
||
|
wait_queue_head_t wait_q;
|
||
|
#if FSM_DEBUG_HISTORY
|
||
|
int history_index;
|
||
|
int history_size;
|
||
|
fsm_history history[FSM_HISTORY_SIZE];
|
||
|
#endif
|
||
|
} fsm_instance;
|
||
|
|
||
|
/**
|
||
|
* Description of a state-event combination
|
||
|
*/
|
||
|
typedef struct {
|
||
|
int cond_state;
|
||
|
int cond_event;
|
||
|
fsm_function_t function;
|
||
|
} fsm_node;
|
||
|
|
||
|
/**
|
||
|
* Description of a FSM Timer.
|
||
|
*/
|
||
|
typedef struct {
|
||
|
fsm_instance *fi;
|
||
|
struct timer_list tl;
|
||
|
int expire_event;
|
||
|
void *event_arg;
|
||
|
} fsm_timer;
|
||
|
|
||
|
/**
|
||
|
* Creates an FSM
|
||
|
*
|
||
|
* @param name Name of this instance for logging purposes.
|
||
|
* @param state_names An array of names for all states for logging purposes.
|
||
|
* @param event_names An array of names for all events for logging purposes.
|
||
|
* @param nr_states Number of states for this instance.
|
||
|
* @param nr_events Number of events for this instance.
|
||
|
* @param tmpl An array of fsm_nodes, describing this FSM.
|
||
|
* @param tmpl_len Length of the describing array.
|
||
|
* @param order Parameter for allocation of the FSM data structs.
|
||
|
*/
|
||
|
extern fsm_instance *
|
||
|
init_fsm(char *name, const char **state_names,
|
||
|
const char **event_names,
|
||
|
int nr_states, int nr_events, const fsm_node *tmpl,
|
||
|
int tmpl_len, gfp_t order);
|
||
|
|
||
|
/**
|
||
|
* Releases an FSM
|
||
|
*
|
||
|
* @param fi Pointer to an FSM, previously created with init_fsm.
|
||
|
*/
|
||
|
extern void kfree_fsm(fsm_instance *fi);
|
||
|
|
||
|
#if FSM_DEBUG_HISTORY
|
||
|
extern void
|
||
|
fsm_print_history(fsm_instance *fi);
|
||
|
|
||
|
extern void
|
||
|
fsm_record_history(fsm_instance *fi, int state, int event);
|
||
|
#endif
|
||
|
|
||
|
/**
|
||
|
* Emits an event to a FSM.
|
||
|
* If an action function is defined for the current state/event combination,
|
||
|
* this function is called.
|
||
|
*
|
||
|
* @param fi Pointer to FSM which should receive the event.
|
||
|
* @param event The event do be delivered.
|
||
|
* @param arg A generic argument, handed to the action function.
|
||
|
*
|
||
|
* @return 0 on success,
|
||
|
* 1 if current state or event is out of range
|
||
|
* !0 if state and event in range, but no action defined.
|
||
|
*/
|
||
|
static inline int
|
||
|
fsm_event(fsm_instance *fi, int event, void *arg)
|
||
|
{
|
||
|
fsm_function_t r;
|
||
|
int state = atomic_read(&fi->state);
|
||
|
|
||
|
if ((state >= fi->f->nr_states) ||
|
||
|
(event >= fi->f->nr_events) ) {
|
||
|
printk(KERN_ERR "fsm(%s): Invalid state st(%ld/%ld) ev(%d/%ld)\n",
|
||
|
fi->name, (long)state,(long)fi->f->nr_states, event,
|
||
|
(long)fi->f->nr_events);
|
||
|
#if FSM_DEBUG_HISTORY
|
||
|
fsm_print_history(fi);
|
||
|
#endif
|
||
|
return 1;
|
||
|
}
|
||
|
r = fi->f->jumpmatrix[fi->f->nr_states * event + state];
|
||
|
if (r) {
|
||
|
#if FSM_DEBUG
|
||
|
printk(KERN_DEBUG "fsm(%s): state %s event %s\n",
|
||
|
fi->name, fi->f->state_names[state],
|
||
|
fi->f->event_names[event]);
|
||
|
#endif
|
||
|
#if FSM_DEBUG_HISTORY
|
||
|
fsm_record_history(fi, state, event);
|
||
|
#endif
|
||
|
r(fi, event, arg);
|
||
|
return 0;
|
||
|
} else {
|
||
|
#if FSM_DEBUG || FSM_DEBUG_HISTORY
|
||
|
printk(KERN_DEBUG "fsm(%s): no function for event %s in state %s\n",
|
||
|
fi->name, fi->f->event_names[event],
|
||
|
fi->f->state_names[state]);
|
||
|
#endif
|
||
|
#if FSM_DEBUG_HISTORY
|
||
|
fsm_print_history(fi);
|
||
|
#endif
|
||
|
return !0;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* Modifies the state of an FSM.
|
||
|
* This does <em>not</em> trigger an event or calls an action function.
|
||
|
*
|
||
|
* @param fi Pointer to FSM
|
||
|
* @param state The new state for this FSM.
|
||
|
*/
|
||
|
static inline void
|
||
|
fsm_newstate(fsm_instance *fi, int newstate)
|
||
|
{
|
||
|
atomic_set(&fi->state,newstate);
|
||
|
#if FSM_DEBUG_HISTORY
|
||
|
fsm_record_history(fi, newstate, -1);
|
||
|
#endif
|
||
|
#if FSM_DEBUG
|
||
|
printk(KERN_DEBUG "fsm(%s): New state %s\n", fi->name,
|
||
|
fi->f->state_names[newstate]);
|
||
|
#endif
|
||
|
wake_up(&fi->wait_q);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* Retrieves the state of an FSM
|
||
|
*
|
||
|
* @param fi Pointer to FSM
|
||
|
*
|
||
|
* @return The current state of the FSM.
|
||
|
*/
|
||
|
static inline int
|
||
|
fsm_getstate(fsm_instance *fi)
|
||
|
{
|
||
|
return atomic_read(&fi->state);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* Retrieves the name of the state of an FSM
|
||
|
*
|
||
|
* @param fi Pointer to FSM
|
||
|
*
|
||
|
* @return The current state of the FSM in a human readable form.
|
||
|
*/
|
||
|
extern const char *fsm_getstate_str(fsm_instance *fi);
|
||
|
|
||
|
/**
|
||
|
* Initializes a timer for an FSM.
|
||
|
* This prepares an fsm_timer for usage with fsm_addtimer.
|
||
|
*
|
||
|
* @param fi Pointer to FSM
|
||
|
* @param timer The timer to be initialized.
|
||
|
*/
|
||
|
extern void fsm_settimer(fsm_instance *fi, fsm_timer *);
|
||
|
|
||
|
/**
|
||
|
* Clears a pending timer of an FSM instance.
|
||
|
*
|
||
|
* @param timer The timer to clear.
|
||
|
*/
|
||
|
extern void fsm_deltimer(fsm_timer *timer);
|
||
|
|
||
|
/**
|
||
|
* Adds and starts a timer to an FSM instance.
|
||
|
*
|
||
|
* @param timer The timer to be added. The field fi of that timer
|
||
|
* must have been set to point to the instance.
|
||
|
* @param millisec Duration, after which the timer should expire.
|
||
|
* @param event Event, to trigger if timer expires.
|
||
|
* @param arg Generic argument, provided to expiry function.
|
||
|
*
|
||
|
* @return 0 on success, -1 if timer is already active.
|
||
|
*/
|
||
|
extern int fsm_addtimer(fsm_timer *timer, int millisec, int event, void *arg);
|
||
|
|
||
|
/**
|
||
|
* Modifies a timer of an FSM.
|
||
|
*
|
||
|
* @param timer The timer to modify.
|
||
|
* @param millisec Duration, after which the timer should expire.
|
||
|
* @param event Event, to trigger if timer expires.
|
||
|
* @param arg Generic argument, provided to expiry function.
|
||
|
*/
|
||
|
extern void fsm_modtimer(fsm_timer *timer, int millisec, int event, void *arg);
|
||
|
|
||
|
#endif /* _FSM_H_ */
|