hpp-bezier-com-traj 6.0.0
Multi contact trajectory generation for the COM using Bezier curves
Loading...
Searching...
No Matches
computeCOMTraj.cpp File Reference
#include <algorithm>
#include <hpp/bezier-com-traj/common_solve_methods.hh>
#include <hpp/bezier-com-traj/cost/costfunction_definition.hh>
#include <hpp/bezier-com-traj/solve.hh>
#include <hpp/bezier-com-traj/solver/solver-abstract.hpp>
#include <hpp/bezier-com-traj/waypoints/waypoints_definition.hh>
#include <hpp/centroidal-dynamics/centroidal_dynamics.hh>
#include <limits>
Include dependency graph for computeCOMTraj.cpp:

Namespaces

namespace  bezier_com_traj
 

Functions

bezier_wp_t::t_point_t bezier_com_traj::computeDiscretizedWwaypoints (const ProblemData &pData, double T, const T_time &timeArray)
 
std::pair< MatrixXX, VectorXbezier_com_traj::dynamicStabilityConstraints_cross (const MatrixXX &mH, const VectorX &h, const Vector3 &g, const coefs_t &c, const coefs_t &ddc)
 
std::pair< MatrixXX, VectorXbezier_com_traj::dynamicStabilityConstraints (const MatrixXX &mH, const VectorX &h, const Vector3 &g, const waypoint_t &w)
 
std::vector< intbezier_com_traj::stepIdPerPhase (const T_time &timeArray)
 
long int bezier_com_traj::computeNumIneq (const ProblemData &pData, const VectorX &Ts, const std::vector< int > &phaseSwitch)
 
void bezier_com_traj::updateH (const ProblemData &pData, const ContactData &phase, MatrixXX &mH, VectorX &h, int &dimH)
 
void bezier_com_traj::assignStabilityConstraintsForTimeStep (MatrixXX &mH, VectorX &h, const waypoint_t &wp_w, const int dimH, long int &id_rows, MatrixXX &A, VectorX &b, const Vector3 &g)
 
void bezier_com_traj::assignStabilityConstraintsForTimeStepForce (const waypoint_t &wp_w, const long int rowIdx, long int &id_cols, const centroidal_dynamics::Matrix6X mG, MatrixXX &D, VectorX &d, const double mass, const Vector3 &g)
 
void bezier_com_traj::switchContactPhase (const ProblemData &pData, MatrixXX &A, VectorX &b, MatrixXX &mH, VectorX &h, const waypoint_t &wp_w, const ContactData &phase, long int &id_rows, int &dimH)
 
long int bezier_com_traj::assignStabilityConstraints (const ProblemData &pData, MatrixXX &A, VectorX &b, const T_time &timeArray, const double t_total, const std::vector< int > &stepIdForPhase)
 
void bezier_com_traj::assignKinematicConstraints (const ProblemData &pData, MatrixXX &A, VectorX &b, const T_time &timeArray, const double t_total, const std::vector< int > &stepIdForPhase, long int &id_rows)
 
void bezier_com_traj::assignAccelerationConstraints (const ProblemData &pData, MatrixXX &A, VectorX &b, const T_time &timeArray, const double t_total, long int &id_rows)
 
std::pair< MatrixXX, VectorXbezier_com_traj::computeConstraintsOneStep (const ProblemData &pData, const VectorX &Ts, const double t_total, const T_time &timeArray)
 
void bezier_com_traj::computeFinalAcceleration (ResultDataCOMTraj &res)
 
void bezier_com_traj::computeFinalVelocity (ResultDataCOMTraj &res)
 
std::pair< MatrixXX, VectorXbezier_com_traj::genCostFunction (const ProblemData &pData, const VectorX &Ts, const double T, const T_time &timeArray, const long int &dim)
 
ResultDataCOMTraj bezier_com_traj::genTraj (ResultData resQp, const ProblemData &pData, const double T)
 
long int bezier_com_traj::computeNumIneqContinuous (const ProblemData &pData, const VectorX &Ts, const int degree, const int w_degree, const bool useDD)
 computeNumIneqContinuous compute the number of inequalitie required by all the phases
 
long int bezier_com_traj::computeNumEqContinuous (const ProblemData &pData, const int w_degree, const bool useForce, long int &forceVarDim)
 computeNumEqContinuous compute the number of equalities required by all the phases
 
std::pair< MatrixXX, VectorXbezier_com_traj::computeConstraintsContinuous (const ProblemData &pData, const VectorX &Ts, std::pair< MatrixXX, VectorX > &Dd, VectorX &minBounds, VectorX &)
 
BEZIER_COM_TRAJ_DLLAPI ResultDataCOMTraj bezier_com_traj::computeCOMTrajFixedSize (const ProblemData &pData, const VectorX &Ts, const unsigned int pointsPerPhase=3)
 computeCOMTraj Tries to solve the one step problem : Given two or three contact phases, an initial and final com position and velocity, try to compute the CoM trajectory (as a Bezier curve) that connect them
 
BEZIER_COM_TRAJ_DLLAPI ResultDataCOMTraj bezier_com_traj::computeCOMTraj (const ProblemData &pData, const VectorX &Ts, const double timeStep=-1, const solvers::SolverType solver=solvers::SOLVER_QUADPROG)
 computeCOMTraj Tries to solve the one step problem : Given two or three contact phases, an initial and final com position and velocity, try to compute the CoM trajectory (as a Bezier curve) that connect them