AGV/MPC/navigation_main.h

//
// Created by zx on 23-5-8.
//

#ifndef NAVIGATION_NAVIGATION_MAIN_H
#define NAVIGATION_NAVIGATION_MAIN_H
#include "navigation.h"
class NavigationMain:public Navigation {

public:
    NavigationMain();
    ~NavigationMain();

    virtual void ResetPose(const Pose2d& pose);
    virtual bool Start(const NavMessage::NavCmd& cmd);
    virtual void publish_statu(NavMessage::NavStatu& statu);
    virtual void SwitchMode(Monitor_emqx::MoveMode mode,float wheelBase){
      move_mode_=mode;
      if(move_mode_==Monitor_emqx::eMain)
      {
        wheelBase_=wheelBase;
      }
    }


protected:
    virtual void SendMoveCmd(Monitor_emqx::MoveMode mode,Monitor_emqx::SpeedType type,
                             double v,double angular);
    virtual void HandleNavCmd(const NavMessage::NavCmd& cmd);
protected:
    float  wheelBase_;   //两节agv的位姿与单节的位姿变换
};

#endif //NAVIGATION_NAVIGATION_MAIN_H