Go to the documentation of this file.
18 #ifndef __invdyn_task_se3_equality_hpp__
19 #define __invdyn_task_se3_equality_hpp__
25 #include <pinocchio/multibody/model.hpp>
26 #include <pinocchio/multibody/data.hpp>
36 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
49 const std::string & frameName);
137 #endif // ifndef __invdyn_task_se3_equality_hpp__
const Vector & position_ref() const
Definition: task-se3-equality.cpp:146
SE3 m_M_ref
Definition: task-se3-equality.hpp:121
Vector m_p_ref
Definition: task-se3-equality.hpp:119
pinocchio::Data::Matrix6x Matrix6x
Definition: task-se3-equality.hpp:43
const Vector & velocity_ref() const
Definition: task-se3-equality.cpp:151
const Vector & velocity_error() const
Definition: task-se3-equality.cpp:131
Vector m_v_error_masked_vec
Definition: task-se3-equality.hpp:117
math::ConstraintEquality ConstraintEquality
Definition: task-se3-equality.hpp:41
Definition: trajectory-base.hpp:35
Definition: constraint-equality.hpp:28
Vector m_a_des_masked
Definition: task-se3-equality.hpp:124
Abstract class representing a linear equality/inequality constraint. Equality constraints are represe...
Definition: constraint-base.hpp:36
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef math::Index Index
Definition: task-se3-equality.hpp:38
Eigen::Matrix< Scalar, Eigen::Dynamic, 1 > Vector
Definition: fwd.hpp:37
Vector m_p
Definition: task-se3-equality.hpp:118
pinocchio::SE3 SE3
Definition: task-se3-equality.hpp:45
virtual void setMask(math::ConstRefVector mask)
Definition: task-se3-equality.cpp:65
SE3 m_wMl
Definition: task-se3-equality.hpp:121
const TrajectorySample & getReference() const
Definition: task-se3-equality.cpp:121
pinocchio::Data Data
Definition: task-se3-equality.hpp:42
const Vector & getDesiredAcceleration() const
Definition: task-se3-equality.cpp:156
const ConstraintBase & compute(const double t, ConstRefVector q, ConstRefVector v, Data &data)
Definition: task-se3-equality.cpp:181
Vector getAcceleration(ConstRefVector dv) const
Definition: task-se3-equality.cpp:161
TrajectorySample m_ref
Definition: task-se3-equality.hpp:130
pinocchio::SE3 SE3
Definition: trajectory-base.hpp:34
Motion m_p_error
Definition: task-se3-equality.hpp:115
Vector m_a_des
Definition: task-se3-equality.hpp:124
Motion m_a_ref
Definition: task-se3-equality.hpp:120
const Vector & velocity() const
Definition: task-se3-equality.cpp:141
Index m_frame_id
Definition: task-se3-equality.hpp:114
Vector m_drift_masked
Definition: task-se3-equality.hpp:126
pinocchio::Motion Motion
Definition: task-se3-equality.hpp:44
Vector m_Kd
Definition: task-se3-equality.hpp:123
std::size_t Index
Definition: fwd.hpp:55
TaskSE3Equality(const std::string &name, RobotWrapper &robot, const std::string &frameName)
Definition: task-se3-equality.cpp:31
bool m_local_frame
Definition: task-se3-equality.hpp:131
const ConstraintBase & getConstraint() const
Definition: task-se3-equality.cpp:171
trajectories::TrajectorySample TrajectorySample
Definition: task-se3-equality.hpp:39
Motion m_drift
Definition: task-se3-equality.hpp:125
Motion m_v_ref
Definition: task-se3-equality.hpp:120
Matrix6x m_J
Definition: task-se3-equality.hpp:127
const Vector & position_error() const
Definition: task-se3-equality.cpp:126
Vector m_p_error_vec
Definition: task-se3-equality.hpp:116
Vector m_Kp
Definition: task-se3-equality.hpp:122
const Vector & Kp() const
Definition: task-se3-equality.cpp:81
Definition: task-motion.hpp:28
const typedef Eigen::Ref< const Vector > ConstRefVector
Definition: fwd.hpp:50
int dim() const
Return the dimension of the task. \info should be overloaded in the child class.
Definition: task-se3-equality.cpp:76
ConstraintEquality m_constraint
Definition: task-se3-equality.hpp:129
pinocchio::Data Data
Definition: task-base.hpp:43
Motion m_v_error
Definition: task-se3-equality.hpp:115
Matrix6x m_J_rotated
Definition: task-se3-equality.hpp:128
Index frame_id() const
Definition: task-se3-equality.cpp:166
Vector m_p_error_masked_vec
Definition: task-se3-equality.hpp:117
Definition: constraint-bound.hpp:26
void setReference(TrajectorySample &ref)
Definition: task-se3-equality.cpp:97
Wrapper for a robot based on pinocchio.
Definition: robot-wrapper.hpp:40
Vector m_v_ref_vec
Definition: task-se3-equality.hpp:119
const Vector & Kd() const
Definition: task-se3-equality.cpp:83
math::Vector Vector
Definition: task-se3-equality.hpp:40
const std::string & name() const
Definition: task-base.cpp:30
Vector m_v
Definition: task-se3-equality.hpp:118
const Vector & position() const
Definition: task-se3-equality.cpp:136
Definition: task-se3-equality.hpp:33
void useLocalFrame(bool local_frame)
Specifies if the jacobian and desired acceloration should be expressed in the local frame or the loca...
Definition: task-se3-equality.cpp:176
math::ConstRefVector ConstRefVector
Definition: task-base.hpp:42
Vector m_v_error_vec
Definition: task-se3-equality.hpp:116
std::string m_frame_name
Definition: task-se3-equality.hpp:113