data.hh

Go to the documentation of this file.

/*
 * Copyright 2018, LAAS-CNRS
 * Author: Steve Tonneau
 */
 
#ifndef BEZIER_COM_TRAJ_LIB_DATA_H
#define BEZIER_COM_TRAJ_LIB_DATA_H
 
#include <ndcurves/bezier_curve.h>
 
#include <Eigen/Dense>
#include <hpp/bezier-com-traj/definitions.hh>
#include <hpp/bezier-com-traj/flags.hh>
#include <hpp/bezier-com-traj/local_config.hh>
#include <hpp/bezier-com-traj/solver/solver-abstract.hpp>
#include <hpp/bezier-com-traj/utils.hh>
#include <hpp/centroidal-dynamics/centroidal_dynamics.hh>
#include <vector>
 
namespace bezier_com_traj {
struct BEZIER_COM_TRAJ_DLLAPI ContactData {
  ContactData()
      : contactPhase_(0),
        Kin_(Eigen::Matrix3d::Zero()),
        kin_(VectorX::Zero(0)),
        Ang_(Eigen::Matrix3d::Zero()),
        ang_(VectorX::Zero(0)) {}
 
  ContactData(const ContactData& other)
      : contactPhase_(
            new centroidal_dynamics::Equilibrium(*(other.contactPhase_))),
        Kin_(other.Kin_),
        kin_(other.kin_),
        Ang_(other.Ang_),
        ang_(other.ang_) {}
 
  ContactData(centroidal_dynamics::Equilibrium* contactPhase)
      : contactPhase_(contactPhase),
        Kin_(Eigen::Matrix3d::Zero()),
        kin_(VectorX::Zero(0)),
        Ang_(Eigen::Matrix3d::Zero()),
        ang_(VectorX::Zero(0)) {}
  ~ContactData() {}
 
  centroidal_dynamics::Equilibrium* contactPhase_;
  MatrixX3 Kin_;  // inequality kinematic constraints
  VectorX kin_;
  MatrixX3 Ang_;  // inequality angular momentum constraints
  VectorX ang_;
};
 
struct BEZIER_COM_TRAJ_DLLAPI Constraints {
  Constraints()
      : flag_(INIT_POS | INIT_VEL | END_VEL | END_POS),
        constraintAcceleration_(false),
        maxAcceleration_(10.),
        reduce_h_(1e-3) {}
 
  Constraints(ConstraintFlag flag)
      : flag_(flag),
        constraintAcceleration_(false),
        maxAcceleration_(10.),
        reduce_h_(1e-3) {}
 
  ~Constraints() {}
 
  ConstraintFlag flag_;
  bool constraintAcceleration_;
  double maxAcceleration_;
  double reduce_h_;
};
 
struct BEZIER_COM_TRAJ_DLLAPI ProblemData {
  ProblemData()
      : c0_(point_t::Zero()),
        dc0_(point_t::Zero()),
        ddc0_(point_t::Zero()),
        j0_(point_t::Zero()),
        c1_(point_t::Zero()),
        dc1_(point_t::Zero()),
        ddc1_(point_t::Zero()),
        j1_(point_t::Zero()),
        useAngularMomentum_(false),
        costFunction_(ACCELERATION),
        representation_(DOUBLE_DESCRIPTION) {}
 
  std::vector<ContactData> contacts_;
  point_t c0_, dc0_, ddc0_, j0_, c1_, dc1_, ddc1_, j1_;
  point_t l0_;
  bool useAngularMomentum_;
  Constraints constraints_;
  CostFunction costFunction_;
  GIWCRepresentation representation_;
};
 
typedef solvers::ResultData ResultData;
 
struct BEZIER_COM_TRAJ_DLLAPI ResultDataCOMTraj : public ResultData {
  ResultDataCOMTraj()
      : ResultData(),
        c_of_t_(bezier_t::zero(3)),
        dL_of_t_(bezier_t::zero(3)),
        dc1_(point_t::Zero()),
        ddc1_(point_t::Zero()) {}
  ~ResultDataCOMTraj() {}
 
  bezier_t c_of_t_;   // center of mass trajectory
  bezier_t dL_of_t_;  // angular momentum derivative trajectory
  point_t dc1_;       // terminal velocity
  point_t ddc1_;      // terminal acceleration
};
}  // end namespace bezier_com_traj
 
#endif