mpc_periodic_com_ref.hpp

Go to the documentation of this file.

#ifndef ROBOTOC_MPC_PERIODIC_COM_REF_HPP_
#define ROBOTOC_MPC_PERIODIC_COM_REF_HPP_
 
#include <vector>
#include <memory>
 
#include "Eigen/Core"
 
#include "robotoc/robot/robot.hpp"
#include "robotoc/cost/com_ref_base.hpp"
#include "robotoc/planner/contact_sequence.hpp"
#include "robotoc/mpc/contact_planner_base.hpp"
 
 
namespace robotoc {
 
class MPCPeriodicCoMRef final : public CoMRefBase {
public:
  MPCPeriodicCoMRef(const double swing_start_time, const double period_active, 
                    const double period_inactive, 
                    const int num_phases_in_period=1);
 
  ~MPCPeriodicCoMRef();
 
  void setPeriod(const double swing_start_time, const double period_active, 
                 const double period_inactive, 
                 const int num_phases_in_period=1);
 
  void setCoMRef(const std::shared_ptr<ContactSequence>& contact_sequence,
                 const std::shared_ptr<ContactPlannerBase>& foot_step_planner);
 
  void updateRef(const GridInfo& grid_info, 
                      Eigen::VectorXd& com_ref) const override;
 
  bool isActive(const GridInfo& grid_info) const override;
 
private:
  std::vector<Eigen::Vector3d> com_;
  std::vector<bool> has_inactive_contacts_;
  double swing_start_time_, period_active_, period_inactive_, period_;
  int num_phases_in_period_;
};
 
} // namespace robotoc
 
#endif // ROBOTOC_MPC_PERIODIC_COM_REF_HPP_