基于C语言的最优HSM状态机架构实现

李肖遥

共 16159字,需浏览 33分钟

 ·

2021-10-21 08:14

关注、星标公众号,直达精彩内容

来源:小鱼儿飞丫飞

整理:技术让梦想更伟大 | 李肖遥


前言:

本框架实现的目的是在基于51单片机为控制芯片的产品内,因为51单片机的内存和堆栈比较有限,此框架比较简洁高效的。如果用于其他高性能的处理器内,可以考虑利用链表实现,实现更自由的操作。

一、双层状态机框架

状态机架构

调度器实现

该状态机有两个父类状态机(可自由添加更多父类状态机)

每个父类状态机内部有若干个子状态机(可自由添加更多子类状态机)

二、直接上代码

头文件如下:

/****************************************************************************
作者:小鱼儿飞丫飞
日期:2020-6-19
文件名:FSM层次状态机头文件
****************************************************************************/
#ifndef  __HSM_H__
#define  __HSM_H__

/****************************************************************************
头文件
****************************************************************************/
#include "stdio.h"
/****************************************************************************
红定义
****************************************************************************/
#define KEPP_STATE_CNT (5)
#define uint8_t  unsigned char
/****************************************************************************
变量
****************************************************************************/
typedef   void (*procedure) (void);//--函数指针
//--定义状态
typedef  enum  _FATHER_STATES{
   s_father_init =0,  
   s_father_keep,
   s_father_done,
   s_father_default,
}E_father_states;
E_father_states  s_father_step;//--父类单个状态内部转换步骤
typedef  enum  _CHILDER_STATES{
   s_childer_init =0,  
   s_childer_keep,
   s_childer_done,
   s_childer_default,
}E_childer_states;
E_childer_states  s_childer_step;//--子类单个状态内部转换步骤
//--定义状态成员函数
typedef  struct  __STATES_FUN{
          procedure  steps[4] ;//--函数指针数组
}S_state_fun;

S_state_fun  father_state[2];//--超类集合
S_state_fun  childer_state[8];//--子类集合

typedef  enum {
    e_static_state =0,
    e_run_state ,
}E_hsm_father_state;
E_hsm_father_state  hsm_current_father_state;//--当前父状态
E_hsm_father_state  hsm_last_father_state;//-上一次父状态
typedef  enum {
    e_set_state =0,
    e_distribution_network_state ,
    e_shut_down_state,
    e_charge_state,
    e_Normal_state,
    e_dry_state,
    e_besiege_state,
    e_avoid_obstacles
}E_hsm_childer_state;
E_hsm_childer_state   hsm_current_childer_state;//--当前子状态
E_hsm_childer_state   hsm_last_childer_state;//--上一次子状态

/****************************************************************************
函数
****************************************************************************/
//--子状态是否允许跳转
uint8_t  Childer_State_Is_Allow_Jump(void);
//--子状态是否要发生状态转换
uint8_t  Is_Three_A_Childer_State_Transition(void);
//--子类状态转换
void  Childer_State_Transition(E_hsm_childer_state  temp);
//--子类更新上一次状态
void  Update_Childer_Last_State_Transition(void);
//--子类单个状态内部转换
void  Childer_Step_Transition(E_childer_states  temp);
//--父状态是否允许跳转
uint8_t  Father_State_Is_Allow_Jump(void);
//--父状态是否要发生状态转换
uint8_t  Is_Three_A_Father_State_Transition(void);
//--夫类状态转换
void  Father_State_Transition(E_hsm_father_state  temp);
//--父类更新上一次状态
void  Update_Father_Last_State_Transition(void);
//--夫类状态内部转换
void  Father_Step_Transition(E_father_states  temp);
/*************************************************
 * 静止状态(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  F_Static_Init(void );
void  F_Static_Keep(void);
void  F_Satic_Done(void );
void  F_Static_Default(void );
/*************************************************
 * 运行状态(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  F_Run_Init(void);
void  F_Run_Keep(void );
void  F_Run_Done(void );
void  F_Run_Default(void );
/*************************************************
 * 设置状态(子类)依附静止(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Static_Set_Init();
void  C_Static_Set_Keep();
void  C_Satic_Set_Done();
void  C_Static_Set_Default();
/*************************************************
 * 配网状态(子类)依附静止(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Static_Distribution_Network_Init(void );
void  C_Static_Distribution_Network_Keep(void );
void  C_Satic_Distribution_Network_Done(void );
void  C_Static_Distribution_Network_Default(void );
/*************************************************
 * 待机状态(子类)依附静止(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Static_Shut_Down_Init(void );
void  C_Static_Shut_Down_Keep(void );
void  C_Satic_Shut_Down_Done(void );
void  C_Static_Shut_Down_Default(void );
/*************************************************
 * 充电状态(子类)依附静止(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Static_Charge_Init(void );
void  C_Static_Charge_Keep(void );
void  C_Satic_Charge_Done(void );
void  C_Static_Charge_Default(void );

/*************************************************
 * 正常状态(子类)依附运行(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Run_Normal_Init(void );
void  C_Run_Normal_Keep(void );
void  C_Run_Normal_Done(void );
void  C_Run_Normal_Default(void );
/*************************************************
 * 干托状态(子类)依附运行(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Run_Dry_Init(void );
void  C_Run_Dry_Keep(void );
void  C_Run_Dry_Done(void );
void  C_Run_Dry_Default(void );
/*************************************************
 * 受困状态(子类)依附运行(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Run_Besiege_Init(void );
void  C_Run_Besiege_Keep(void );
void  C_Run_Besiege_Done(void);
void  C_Run_Besiege_Default(void);
/*************************************************
 * 避障状态(子类)依附运行(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Run_Avoid_Obstacles_Init(void );
void  C_Run_Avoid_Obstacles_Keep(void );
void  C_Run_Avoid_Obstacles_Done(void );
void  C_Run_Avoid_Obstacles_Default(void );


#endif

实现文件如下:

/****************************************************************************
作者:小鱼儿飞丫飞
日期:2020-6-19
文件名:FSM层次状态机执行文件
****************************************************************************/
/****************************************************************************
头文件
****************************************************************************/
#include  "hsm.h"
/****************************************************************************
红定义
****************************************************************************/

/****************************************************************************
变量
****************************************************************************/

S_state_fun father_state[2] ={
{F_Static_Init,F_Static_Keep,F_Satic_Done,F_Static_Default},
{F_Run_Init,F_Run_Keep,F_Run_Done,F_Run_Default }
};//--超类/夫类
S_state_fun childer_state[8]={
{ C_Static_Set_Init,C_Static_Set_Keep,C_Satic_Set_Done,C_Static_Set_Default},
{C_Static_Distribution_Network_Init,C_Static_Distribution_Network_Keep,C_Satic_Distribution_Network_Done,C_Static_Distribution_Network_Default},
{C_Static_Shut_Down_Init,C_Static_Shut_Down_Keep,C_Satic_Shut_Down_Done,C_Static_Shut_Down_Default},
{C_Static_Charge_Init,C_Static_Charge_Keep,C_Satic_Charge_Done,C_Static_Charge_Default},
{ C_Run_Normal_Init,C_Run_Normal_Keep,C_Run_Normal_Done,C_Run_Normal_Default},
{ C_Run_Dry_Init,C_Run_Dry_Keep, C_Run_Dry_Done,C_Run_Dry_Default},
{ C_Run_Besiege_Init,C_Run_Besiege_Keep,C_Run_Besiege_Done, C_Run_Besiege_Default},
{C_Run_Avoid_Obstacles_Init,C_Run_Avoid_Obstacles_Keep,C_Run_Avoid_Obstacles_Done,C_Run_Avoid_Obstacles_Default}
};//--子类1
E_father_states s_father_step=s_father_init ; //--父类单个状态内部转换步骤
E_childer_states s_childer_step = s_childer_init;
E_hsm_father_state hsm_current_father_state =  e_static_state;//--父类初始化
E_hsm_father_state hsm_last_father_state =  e_static_state ;
E_hsm_childer_state hsm_current_childer_state = e_set_state;//--子类初始化
E_hsm_childer_state hsm_last_childer_state = e_set_state;
/****************************************************************************
函数  
状态函数命名规则
     例 : C_Static_Set_Init 
              C   _  Static_   Set  _    Init
         C:子类 F:父类_依附的父类_子类本身名字_该子类状态内部阶段
****************************************************************************/
int  main(void)
{
   int update_cnt = 10;
   int run_cnt =1;
   int cnt;
while(1)
 {

if(update_cnt==80)
  {
  hsm_current_father_state =0;
  hsm_current_childer_state = 0;
  }
else if(update_cnt==70)
  {
  hsm_current_father_state =0;
  hsm_current_childer_state = 1;
  }
else if(update_cnt==60)
  {
  hsm_current_father_state =0;
  hsm_current_childer_state = 2;
  }
else if(update_cnt==50)
  {
  hsm_current_father_state =0;
  hsm_current_childer_state = 3;
  }
else if(update_cnt==40)
  {
  hsm_current_father_state =1;
  hsm_current_childer_state = 4;
  }
else if(update_cnt==30)
  {
  hsm_current_father_state =1;
  hsm_current_childer_state = 5;
  }
else if(update_cnt==20)
  {
  hsm_current_father_state =1;
  hsm_current_childer_state = 6;
  }
else if(update_cnt==10)
  {
  hsm_current_father_state =1;
  hsm_current_childer_state = 7;
  }
update_cnt--;
if(update_cnt==0)
{update_cnt =80;}
 // printf("hsm_current_father_state:%d hsm_current_childer_state:%d\r\n",hsm_current_father_state,hsm_current_childer_state);
   //=================================父类状态机调度器=========================================
  if(Father_State_Is_Allow_Jump())//--如果允许跳转
    father_state[hsm_current_father_state].steps[s_father_step]();//--父类状态
    else
    father_state[hsm_last_father_state].steps[s_father_step]();//--父类状态
   //==========================================================================
   
 }
 return 0;
}
//--子状态是否允许跳转
uint8_t  Childer_State_Is_Allow_Jump(void)
{
 if(s_childer_step == s_childer_init)
   return 1;
 else   
   return 0;
}
//--子状态是否要发生状态转换
uint8_t  Is_Three_A_Childer_State_Transition(void)
{
 if(hsm_last_childer_state == hsm_current_childer_state)
   return 0;
 else   
   return 1;
}
//--子类状态转换
void  Childer_State_Transition(E_hsm_childer_state  temp)
{
 hsm_current_childer_state = temp;
}
//--子类更新上一次状态
void  Update_Childer_Last_State_Transition(void)
{
 hsm_last_childer_state = hsm_current_childer_state;
}
//--子类单个状态内部转换
void  Childer_Step_Transition(E_childer_states  temp)
{
 s_childer_step = temp;
}
//--父状态是否允许跳转
uint8_t  Father_State_Is_Allow_Jump(void)
{
 if(s_father_step == s_father_init)
   return 1;
 else   
   return 0;
}
//--父状态是否要发生状态转换
uint8_t  Is_Three_A_Father_State_Transition(void)
{
 if(hsm_last_father_state == hsm_current_father_state)
   return 0;
 else   
   return 1;
}
//--夫类状态转换
void  Father_State_Transition(E_hsm_father_state  temp)
{
 hsm_current_father_state = temp;
}
//--父类更新上一次状态
void  Update_Father_Last_State_Transition(void)
{
 hsm_last_father_state = hsm_current_father_state;
}
//--夫类状态内部转换
void  Father_Step_Transition(E_father_states  temp)
{
 s_father_step = temp;
}
/*************************************************
 * 静止状态(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  F_Static_Init(void)
{
  Update_Father_Last_State_Transition();
   //---------------------
  //--代码段
  printf("===父类:静止状态====进入函数>>>>>>>>>>>>>>>>>>>>>\r\n");
   //--------------------
   Father_Step_Transition(s_father_keep);
}
void  F_Static_Keep(void )
{
     //---------------------
    //--代码段
   // printf("===父类:静止状态====保持函数--------------------\r\n");
    //==========子类状态机调度器======================
    if(Childer_State_Is_Allow_Jump())//--如果允许跳转
    {
     //--如果父类出现类跳转,子类已经做好跳转的准备,但是父类还未做好跳转的准备,此时不执行子类跳转
    if(Is_Three_A_Father_State_Transition())
      {
       Father_Step_Transition(s_father_done);
       return;
      }  
    else
       Father_Step_Transition(s_father_keep);     
    childer_state[hsm_current_childer_state].steps[s_childer_step]();//--子类状态
    }
    else
    childer_state[hsm_last_childer_state].steps[s_childer_step]();//--子类状态
    //--------------------

}
void  F_Satic_Done(void)
{
   //---------------------
  //--代码段
  printf("===父类:静止状态====退出函数<<<<<<<<<<<<<<<<<<<<<<<<\r\n");
   //--------------------
   //--内部切换
   Father_Step_Transition(s_father_init);
}
void  F_Static_Default(void )
{
  ;
}
/*************************************************
 * 运行状态(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  F_Run_Init(void )
{
  Update_Father_Last_State_Transition();
   //---------------------
  //--代码段
  printf("===父类:运行状态====进入函数>>>>>>>>>>>>>>>>>>>>>>>>>>\r\n");
   //--------------------
   Father_Step_Transition(s_father_keep);
}
void  F_Run_Keep(void )
{
     //---------------------
    //--代码段
    //printf("===父类:运行状态====保持函数--------------------\r\n");
    //==========子类状态机调度器======================
    if(Childer_State_Is_Allow_Jump())//--如果允许跳转
    {
     //--如果父类出现类跳转,子类已经做好跳转的准备,但是父类还未做好跳转的准备,此时不执行子类跳转
    if(Is_Three_A_Father_State_Transition())
      {
       Father_Step_Transition(s_father_done);
       return;
      }  
    else
       Father_Step_Transition(s_father_keep);     
    childer_state[hsm_current_childer_state].steps[s_childer_step]();//--子类状态
    }
    else
    childer_state[hsm_last_childer_state].steps[s_childer_step]();//--子类状态
}
void  F_Run_Done(void)
{
   //---------------------
  //--代码段
  printf("===父类:运行状态====退出函数<<<<<<<<<<<<<<<<<<<<<<\r\n");
   //--------------------
   //--内部切换
   Father_Step_Transition(s_father_init);
}
void  F_Run_Default(void )
{
  ;
}
/*************************************************
 * 设置状态(子类)依附静止(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Static_Set_Init(void )
{
  Update_Childer_Last_State_Transition();
  //---------------------
  //--代码段
  printf("===子类:设置状态====进入函数>>>\r\n");
  //--------------------
  Childer_Step_Transition(s_childer_keep);
}
void  C_Static_Set_Keep(void )
{
     //---------------------
    //--代码段
    printf("===子类:设置状态====保持函数\r\n");
    //--------------------
    if(Is_Three_A_Childer_State_Transition())
       Childer_Step_Transition(s_childer_done); 
    else
       Childer_Step_Transition(s_childer_keep);
}
void  C_Satic_Set_Done(void )
{
   //---------------------
  //--代码段
   printf("===子类:设置状态====退出函数<<<\r\n");
   //--------------------
   //--内部切换
   Childer_Step_Transition(s_childer_init);
}
void  C_Static_Set_Default(void)
{
  ;
}
/*************************************************
 * 配网状态(子类)依附静止(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Static_Distribution_Network_Init(void )
{
  Update_Childer_Last_State_Transition();
   //---------------------
  //--代码段
  printf("===子类:陪网状态====进入函数>>>\r\n");
  //--------------------
  Childer_Step_Transition(s_childer_keep);
}
void  C_Static_Distribution_Network_Keep(void )
{
     //---------------------
    //--代码段
    printf("===子类:陪网状态====保持函数\r\n");
    //--------------------
    if(Is_Three_A_Childer_State_Transition())
       Childer_Step_Transition(s_childer_done); 
    else
       Childer_Step_Transition(s_childer_keep);
}
void  C_Satic_Distribution_Network_Done(void )
{
   //---------------------
  //--代码段
   printf("===子类:陪网状态====退出函数<<<\r\n");
   //--------------------
   //--内部切换
   Childer_Step_Transition(s_childer_init);
}
void  C_Static_Distribution_Network_Default(void )
{
  ;
}
/*************************************************
 * 待机状态(子类)依附静止(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Static_Shut_Down_Init(void )
{
  Update_Childer_Last_State_Transition();
   //---------------------
  //--代码段
  printf("===子类:待机状态====进入函数>>>\r\n");
  //--------------------
  Childer_Step_Transition(s_childer_keep);
}
void  C_Static_Shut_Down_Keep(void )
{
     //---------------------
    //--代码段
    printf("===子类:待机状态====保持函数\r\n");
    //--------------------
    if(Is_Three_A_Childer_State_Transition())
       Childer_Step_Transition(s_childer_done); 
    else
       Childer_Step_Transition(s_childer_keep);
}
void  C_Satic_Shut_Down_Done(void )
{
   //---------------------
   //--代码段
   printf("===子类:待机状态====退出函数<<<\r\n");
   //--------------------
   //--内部切换
   Childer_Step_Transition(s_childer_init);
}
void  C_Static_Shut_Down_Default(void )
{
  ;
}

/*************************************************
 * 充电状态(子类)依附静止(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/

void  C_Static_Charge_Init(void )
{
  Update_Childer_Last_State_Transition();
   //---------------------
  //--代码段
  printf("===子类:充电状态====进入函数>>>\r\n");
  //--------------------
  Childer_Step_Transition(s_childer_keep);
}
void  C_Static_Charge_Keep(void )
{
     //---------------------
    //--代码段
    printf("===子类:充电状态====保持函数\r\n");
    //--------------------
    if(Is_Three_A_Childer_State_Transition())
       Childer_Step_Transition(s_childer_done); 
    else
       Childer_Step_Transition(s_childer_keep);
}
void  C_Satic_Charge_Done(void )
{
    //---------------------
   //--代码段
   printf("===子类:充电状态====退出函数<<<\r\n");
   //--------------------
   //--内部切换
   Childer_Step_Transition(s_childer_init);
}
void  C_Static_Charge_Default(void )
{
  ;
}

/*************************************************
 * 正常状态(子类)依附运行(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Run_Normal_Init(void )
{
  Update_Childer_Last_State_Transition();
   //---------------------
  //--代码段
  printf("===子类:正常状态====进入函数>>>\r\n");
  //--------------------
  Childer_Step_Transition(s_childer_keep);
}
void  C_Run_Normal_Keep(void )
{
     //---------------------
    //--代码段
    printf("===子类:正常状态====保持函数\r\n");
    //--------------------
    if(Is_Three_A_Childer_State_Transition())
       Childer_Step_Transition(s_childer_done); 
    else
       Childer_Step_Transition(s_childer_keep);
}
void  C_Run_Normal_Done(void)
{
    //---------------------
   //--代码段
   printf("===子类:正常状态====退出函数<<<\r\n");
   //--------------------
   //--内部切换
   Childer_Step_Transition(s_childer_init);
}
void  C_Run_Normal_Default(void)
{
  ;
}
/*************************************************
 * 干托状态(子类)依附运行(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Run_Dry_Init(void )
{
  Update_Childer_Last_State_Transition();
  //---------------------
  //--代码段
  printf("===子类:干托状态====进入函数>>>\r\n");
  //--------------------
  Childer_Step_Transition(s_childer_keep);
}
void  C_Run_Dry_Keep(void )
{
     //---------------------
    //--代码段
    printf("===子类:干托状态====保持函数\r\n");
    //--------------------
    if(Is_Three_A_Childer_State_Transition())
       Childer_Step_Transition(s_childer_done); 
    else
       Childer_Step_Transition(s_childer_keep);
}
void  C_Run_Dry_Done(void )
{
   //---------------------
   //--代码段
   printf("===子类:干托状态====退出函数<<<\r\n");
   //--------------------
   //--内部切换
   Childer_Step_Transition(s_childer_init);
}
void  C_Run_Dry_Default(void )
{
  ;
}
/*************************************************
 * 受困状态(子类)依附运行(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Run_Besiege_Init(void )
{
  Update_Childer_Last_State_Transition();
  //---------------------
  //--代码段
  printf("===子类:受困状态====进入函数>>>\r\n");
  //--------------------
  Childer_Step_Transition(s_childer_keep);
}
void  C_Run_Besiege_Keep(void )
{
     //---------------------
    //--代码段
    printf("===子类:受困状态====保持函数\r\n");
    //--------------------
    if(Is_Three_A_Childer_State_Transition())
       Childer_Step_Transition(s_childer_done); 
    else
       Childer_Step_Transition(s_childer_keep);
}
void  C_Run_Besiege_Done(void )
{
   //---------------------
   //--代码段
   printf("===子类:受困状态====退出函数<<<\r\n");
   //--------------------
   //--内部切换
   Childer_Step_Transition(s_childer_init);
}
void  C_Run_Besiege_Default(void )
{
  ;
}
/*************************************************
 * 避障状态(子类)依附运行(夫类)
 * 进入函数
 * 保持函数
 * 退出函数
 * 错误函数
 * *************************************************/
void  C_Run_Avoid_Obstacles_Init(void )
{
  Update_Childer_Last_State_Transition();
  //---------------------
  //--代码段
  printf("===子类:避障状态====进入函数>>>\r\n");
  //--------------------
  Childer_Step_Transition(s_childer_keep);
}
void  C_Run_Avoid_Obstacles_Keep(void )
{
     //---------------------
    //--代码段
    printf("===子类:避障状态====保持函数\r\n");
    //--------------------
    if(Is_Three_A_Childer_State_Transition())
       Childer_Step_Transition(s_childer_done); 
    else
       Childer_Step_Transition(s_childer_keep);
}
void  C_Run_Avoid_Obstacles_Done(void )
{
    //---------------------
   //--代码段
   printf("===子类:避障状态====退出函数<<<\r\n");
   //--------------------
   //--内部切换
   Childer_Step_Transition(s_childer_init);
}
void  C_Run_Avoid_Obstacles_Default(void )
{
  ;
}

三、运行情况

版权归原作者所有,如有转载请联系我,如有侵权,请联系删除。
‧‧‧‧‧‧‧‧‧‧‧‧‧‧‧‧  END  ‧‧‧‧‧‧‧‧‧‧‧‧‧‧‧‧

关注我的微信公众号,回复“加群”按规则加入技术交流群。

欢迎关注我的视频号:


点击“阅读原文”查看更多分享,欢迎点分享、收藏、点赞、在看。

浏览 38
点赞
评论
收藏
分享

手机扫一扫分享

分享
举报
评论
图片
表情
推荐
点赞
评论
收藏
分享

手机扫一扫分享

分享
举报