Go to the documentation of this file.
18 #ifndef __invdyn_task_joint_posVelAcc_bounds_hpp__
19 #define __invdyn_task_joint_posVelAcc_bounds_hpp__
24 #include <tsid/deprecated.hh>
41 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
75 bool impose_velocity_bounds,
76 bool impose_viability_bounds,
77 bool impose_acceleration_bounds);
190 #endif // ifndef __invdyn_task_joint_bounds_hpp__
const ConstraintBase & compute(const double t, ConstRefVector q, ConstRefVector v, Data &data)
Definition: task-joint-posVelAcc-bounds.cpp:200
Vector m_ddqUB
Definition: task-joint-posVelAcc-bounds.hpp:147
void setTimeStep(double dt)
Definition: task-joint-posVelAcc-bounds.cpp:161
Vector m_ddqUBAcc
Definition: task-joint-posVelAcc-bounds.hpp:144
Vector m_ddqMax_q2
Definition: task-joint-posVelAcc-bounds.hpp:160
Vector m_dqMinViab
Definition: task-joint-posVelAcc-bounds.hpp:134
void computeAccLimitsFromPosLimits(ConstRefVector q, ConstRefVector dq, bool verbose=true)
Definition: task-joint-posVelAcc-bounds.cpp:287
bool m_impose_velocity_bounds
Definition: task-joint-posVelAcc-bounds.hpp:150
Vector m_mask
Definition: task-joint-posVelAcc-bounds.hpp:121
Vector m_ddqLB
Definition: task-joint-posVelAcc-bounds.hpp:146
Abstract class representing a linear equality/inequality constraint. Equality constraints are represe...
Definition: constraint-base.hpp:36
Vector m_ddq_2
Definition: task-joint-posVelAcc-bounds.hpp:176
TaskJointPosVelAccBounds(const std::string &name, RobotWrapper &robot, double dt, bool verbose=true)
Definition: task-joint-posVelAcc-bounds.cpp:37
Vector m_ddqMax
Definition: task-joint-posVelAcc-bounds.hpp:132
Vector m_ddqLBPos
Definition: task-joint-posVelAcc-bounds.hpp:137
Eigen::Matrix< Scalar, Eigen::Dynamic, 1 > Vector
Definition: fwd.hpp:37
Definition: constraint-bound.hpp:28
Vector m_b_1
Definition: task-joint-posVelAcc-bounds.hpp:173
const ConstraintBase & getConstraint() const
Definition: task-joint-posVelAcc-bounds.cpp:195
Vector m_dt_two_dq
Definition: task-joint-posVelAcc-bounds.hpp:167
Vector m_ub
Definition: task-joint-posVelAcc-bounds.hpp:183
double m_two_dt_sq
Definition: task-joint-posVelAcc-bounds.hpp:157
Vector m_qMax
Definition: task-joint-posVelAcc-bounds.hpp:130
const TSID_DEPRECATED Vector & mask() const
Definition: task-joint-posVelAcc-bounds.cpp:115
bool m_impose_viability_bounds
Definition: task-joint-posVelAcc-bounds.hpp:151
Vector m_minus_dq_over_dt
Definition: task-joint-posVelAcc-bounds.hpp:162
Vector m_viabViol
Definition: task-joint-posVelAcc-bounds.hpp:154
void setPositionBounds(ConstRefVector lower, ConstRefVector upper)
Definition: task-joint-posVelAcc-bounds.cpp:171
Vector m_dqMaxViab
Definition: task-joint-posVelAcc-bounds.hpp:135
Vector m_dt_ddqMax_dt
Definition: task-joint-posVelAcc-bounds.hpp:169
VectorXi m_activeAxes
Definition: task-joint-posVelAcc-bounds.hpp:122
virtual void setMask(math::ConstRefVector mask)
Definition: task-joint-posVelAcc-bounds.cpp:126
void setVerbose(bool verbose)
Definition: task-joint-posVelAcc-bounds.cpp:167
Vector m_ddqLBAcc
Definition: task-joint-posVelAcc-bounds.hpp:143
Vector m_ddqLBVel
Definition: task-joint-posVelAcc-bounds.hpp:141
void setAccelerationBounds(ConstRefVector upper)
Definition: task-joint-posVelAcc-bounds.cpp:188
Vector m_c_2
Definition: task-joint-posVelAcc-bounds.hpp:179
Vector m_ddqMin_q2
Definition: task-joint-posVelAcc-bounds.hpp:161
const Vector & getAccelerationBounds() const
Definition: task-joint-posVelAcc-bounds.cpp:149
double m_dt
Definition: task-joint-posVelAcc-bounds.hpp:117
double m_two_a
Definition: task-joint-posVelAcc-bounds.hpp:172
void computeAccLimitsFromViability(ConstRefVector q, ConstRefVector dq, bool verbose=true)
Definition: task-joint-posVelAcc-bounds.cpp:346
math::VectorXi VectorXi
Definition: task-joint-posVelAcc-bounds.hpp:46
Vector m_qa
Definition: task-joint-posVelAcc-bounds.hpp:124
Vector m_dt_dq
Definition: task-joint-posVelAcc-bounds.hpp:166
Eigen::VectorXi VectorXi
Definition: fwd.hpp:39
math::ConstraintBound ConstraintBound
Definition: task-joint-posVelAcc-bounds.hpp:44
bool m_impose_acceleration_bounds
Definition: task-joint-posVelAcc-bounds.hpp:152
Vector m_ddqLBVia
Definition: task-joint-posVelAcc-bounds.hpp:139
Vector m_ddqUBPos
Definition: task-joint-posVelAcc-bounds.hpp:138
bool m_verbose
Definition: task-joint-posVelAcc-bounds.hpp:118
Vector m_two_ddqMax
Definition: task-joint-posVelAcc-bounds.hpp:168
double m_eps
Definition: task-joint-posVelAcc-bounds.hpp:127
Vector m_c_1
Definition: task-joint-posVelAcc-bounds.hpp:177
bool m_impose_position_bounds
Definition: task-joint-posVelAcc-bounds.hpp:149
Vector m_dqMax
Definition: task-joint-posVelAcc-bounds.hpp:131
Definition: constraint-inequality.hpp:28
void setImposeBounds(bool impose_position_bounds, bool impose_velocity_bounds, bool impose_viability_bounds, bool impose_acceleration_bounds)
Definition: task-joint-posVelAcc-bounds.cpp:216
int m_na
Definition: task-joint-posVelAcc-bounds.hpp:119
Vector m_ddqMax_q3
Definition: task-joint-posVelAcc-bounds.hpp:158
Definition: task-joint-posVelAcc-bounds.hpp:38
Definition: task-motion.hpp:28
const typedef Eigen::Ref< const Vector > ConstRefVector
Definition: fwd.hpp:50
Vector m_delta_2
Definition: task-joint-posVelAcc-bounds.hpp:180
pinocchio::Data Data
Definition: task-base.hpp:43
Vector m_ddqUBVia
Definition: task-joint-posVelAcc-bounds.hpp:140
Vector m_ddqUBVel
Definition: task-joint-posVelAcc-bounds.hpp:142
Vector m_q_plus_dt_dq
Definition: task-joint-posVelAcc-bounds.hpp:171
int m_nv
Definition: task-joint-posVelAcc-bounds.hpp:119
Definition: constraint-bound.hpp:26
Vector m_delta_1
Definition: task-joint-posVelAcc-bounds.hpp:178
Vector m_dqa
Definition: task-joint-posVelAcc-bounds.hpp:125
int dim() const
Return the dimension of the task. \info should be overloaded in the child class.
Definition: task-joint-posVelAcc-bounds.cpp:146
Wrapper for a robot based on pinocchio.
Definition: robot-wrapper.hpp:40
pinocchio::Data Data
Definition: task-joint-posVelAcc-bounds.hpp:47
const Vector & getPositionUpperBounds() const
Definition: task-joint-posVelAcc-bounds.cpp:158
const std::string & name() const
Definition: task-base.cpp:30
void computeAccLimits(ConstRefVector q, ConstRefVector dq, bool verbose=true)
Definition: task-joint-posVelAcc-bounds.cpp:399
void setVelocityBounds(ConstRefVector upper)
Definition: task-joint-posVelAcc-bounds.cpp:181
Vector m_qMin
Definition: task-joint-posVelAcc-bounds.hpp:129
Vector m_lb
Definition: task-joint-posVelAcc-bounds.hpp:184
void isStateViable(ConstRefVector q, ConstRefVector dq, bool verbose=true)
Definition: task-joint-posVelAcc-bounds.cpp:228
Vector m_dq_square
Definition: task-joint-posVelAcc-bounds.hpp:170
const Vector & getPositionLowerBounds() const
Definition: task-joint-posVelAcc-bounds.cpp:155
Vector m_b_2
Definition: task-joint-posVelAcc-bounds.hpp:174
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef math::Vector Vector
Definition: task-joint-posVelAcc-bounds.hpp:43
ConstraintInequality m_constraint
Definition: task-joint-posVelAcc-bounds.hpp:116
Vector m_ddqMin_q3
Definition: task-joint-posVelAcc-bounds.hpp:159
math::ConstraintInequality ConstraintInequality
Definition: task-joint-posVelAcc-bounds.hpp:45
double m_dt_square
Definition: task-joint-posVelAcc-bounds.hpp:165
math::ConstRefVector ConstRefVector
Definition: task-base.hpp:42
Vector m_ddq_1
Definition: task-joint-posVelAcc-bounds.hpp:175
const Vector & getVelocityBounds() const
Definition: task-joint-posVelAcc-bounds.cpp:152