Go2Py_SIM/locomotion/custom/include/Planner/ReactivePlanner.hpp

30 lines
605 B
C++

#pragma once
#include "Planner/Planner.hpp"
class ReactivePlanner : public Planner {
public:
ReactivePlanner();
ReactivePlanner(std::string name);
~ReactivePlanner() {}
vec3 getDesiredFootPosition(const uint8_t&, const float&) override;
// void SetBaseTarget () override;
void setTarget() override;
void initClass();
private:
// std_msgs::Float32MultiArray m_p_cs_phi;
Eigen::MatrixXd getVPSPVertices(const float& t);
double getVPSPStabilityMargin();
std::string m_name;
bool use_vpsp = true;
bool m_use_capture_point_heuristic = true;
};