move_fsm.h

#pragma once
 
#include "software/ai/hl/stp/tactic/tactic.h"
 
struct MoveFSM
{
   public:
    // these classes define the states used in the transition table
    // they are exposed so that tests can check if the FSM is in a particular state
    class MoveState;
 
    // this struct defines the unique control parameters that the MoveFSM requires in its
    // update
    struct ControlParams
    {
        // The point the robot is trying to move to
        Point destination;
        // The orientation the robot should have when it arrives at its destination
        Angle final_orientation;
        // How to run the dribbler
        TbotsProto::DribblerMode dribbler_mode;
        // How to navigate around the ball
        TbotsProto::BallCollisionType ball_collision_type;
        // The command to autochip or autokick
        AutoChipOrKick auto_chip_or_kick;
        // The maximum allowed speed mode
        TbotsProto::MaxAllowedSpeedMode max_allowed_speed_mode;
        // The obstacle avoidance mode
        TbotsProto::ObstacleAvoidanceMode obstacle_avoidance_mode;
    };
 
    // this struct defines the only event that the MoveFSM responds to
    DEFINE_TACTIC_UPDATE_STRUCT_WITH_CONTROL_AND_COMMON_PARAMS
 
    void updateMove(const Update &event);
 
    bool moveDone(const Update &event);
 
    auto operator()()
    {
        using namespace boost::sml;
 
        // MoveState_S is the _state_ used in the transition table
        DEFINE_SML_STATE(MoveState)
        // Update_E is the _event_ that the MoveFSM responds to
        DEFINE_SML_EVENT(Update)
 
        DEFINE_SML_GUARD(moveDone)
        DEFINE_SML_ACTION(updateMove)
 
        return make_transition_table(
            // src_state + event [guard] / action = dest_state
            *MoveState_S + Update_E[!moveDone_G] / updateMove_A = MoveState_S,
            MoveState_S + Update_E[moveDone_G] / updateMove_A   = X,
            X + Update_E[!moveDone_G] / updateMove_A            = MoveState_S,
            X + Update_E / updateMove_A                         = X);
    }
};