tsid 1.9.0
Efficient Task Space Inverse Dynamics for Multi-body Systems based on Pinocchio
Loading...
Searching...
No Matches
tsid::tasks::TaskTwoFramesEquality Class Reference

#include <tsid/tasks/task-two-frames-equality.hpp>

Inheritance diagram for tsid::tasks::TaskTwoFramesEquality:
Collaboration diagram for tsid::tasks::TaskTwoFramesEquality:

Public Types

typedef trajectories::TrajectorySample TrajectorySample
typedef math::Vector Vector
typedef math::ConstraintEquality ConstraintEquality
typedef pinocchio::Data Data
typedef pinocchio::Data::Matrix6x Matrix6x
typedef pinocchio::Motion Motion
typedef pinocchio::SE3 SE3
Public Types inherited from tsid::tasks::TaskMotion
typedef trajectories::TrajectorySample TrajectorySample
Public Types inherited from tsid::tasks::TaskBase
typedef math::ConstRefVector ConstRefVector
typedef pinocchio::Data Data
typedef robots::RobotWrapper RobotWrapper

Public Member Functions

 TaskTwoFramesEquality (const std::string &name, RobotWrapper &robot, const std::string &frameName1, const std::string &frameName2)
int dim () const override
 Return the dimension of the task. \info should be overloaded in the child class.
const ConstraintBasecompute (const double t, ConstRefVector q, ConstRefVector v, Data &data) override
const ConstraintBasegetConstraint () const override
const VectorgetDesiredAcceleration () const override
Vector getAcceleration (ConstRefVector dv) const override
virtual void setMask (math::ConstRefVector mask) override
const Vectorposition_error () const override
const Vectorvelocity_error () const override
const VectorKp () const
const VectorKd () const
void Kp (ConstRefVector Kp)
void Kd (ConstRefVector Kp)
Index frame_id1 () const
Index frame_id2 () const
void useLocalFrame (bool local_frame)
 Specifies if the jacobian and desired acceloration should be expressed in the local frame or the local world-oriented frame.
Public Member Functions inherited from tsid::tasks::TaskMotion
 TaskMotion (const std::string &name, RobotWrapper &robot)
virtual const TrajectorySamplegetReference () const
virtual const Vectorposition () const
virtual const Vectorvelocity () const
virtual const Vectorposition_ref () const
virtual const Vectorvelocity_ref () const
virtual const VectorgetMask () const
virtual bool hasMask ()
Public Member Functions inherited from tsid::tasks::TaskBase
 TaskBase (const std::string &name, RobotWrapper &robot)
virtual ~TaskBase ()=default
const std::string & name () const
void name (const std::string &name)

Public Attributes

EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef math::Index Index
Public Attributes inherited from tsid::tasks::TaskMotion
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef math::Vector Vector
Public Attributes inherited from tsid::tasks::TaskBase
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef math::ConstraintBase ConstraintBase

Protected Attributes

std::string m_frame_name1
std::string m_frame_name2
Index m_frame_id1
Index m_frame_id2
Motion m_p_error
Motion m_v_error
Vector m_p_error_vec
Vector m_v_error_vec
Vector m_p_error_masked_vec
Vector m_v_error_masked_vec
Vector m_p
Vector m_v
Vector m_p_ref
Vector m_v_ref_vec
Motion m_v_ref
Motion m_a_ref
SE3 m_wMl1
SE3 m_wMl2
Vector m_Kp
Vector m_Kd
Vector m_a_des
Vector m_a_des_masked
Motion m_drift
Vector m_drift_masked
Matrix6x m_J1
Matrix6x m_J2
Matrix6x m_J1_rotated
Matrix6x m_J2_rotated
ConstraintEquality m_constraint
Protected Attributes inherited from tsid::tasks::TaskMotion
Vector m_mask
Vector m_dummy
trajectories::TrajectorySample TrajectorySample_dummy
Protected Attributes inherited from tsid::tasks::TaskBase
std::string m_name
RobotWrapperm_robot
 Reference on the robot model.

Member Typedef Documentation

◆ ConstraintEquality

◆ Data

◆ Matrix6x

typedef pinocchio::Data::Matrix6x tsid::tasks::TaskTwoFramesEquality::Matrix6x

◆ Motion

◆ SE3

◆ TrajectorySample

◆ Vector

Constructor & Destructor Documentation

◆ TaskTwoFramesEquality()

tsid::tasks::TaskTwoFramesEquality::TaskTwoFramesEquality(const std::string &name,
RobotWrapper &robot,
const std::string &frameName1,
const std::string &frameName2 )

Member Function Documentation

◆ compute()

const ConstraintBase & tsid::tasks::TaskTwoFramesEquality::compute(const doublet,
ConstRefVectorq,
ConstRefVectorv,
Data &data )
overridevirtual

◆ dim()

int tsid::tasks::TaskTwoFramesEquality::dim()const
overridevirtual

Return the dimension of the task. \info should be overloaded in the child class.

Implements tsid::tasks::TaskBase.

◆ frame_id1()

Index tsid::tasks::TaskTwoFramesEquality::frame_id1()const

◆ frame_id2()

Index tsid::tasks::TaskTwoFramesEquality::frame_id2()const

◆ getAcceleration()

Vector tsid::tasks::TaskTwoFramesEquality::getAcceleration(ConstRefVectordv)const
overridevirtual

Return the task acceleration (after applying the specified mask). The value is expressed in local frame is the local_frame flag is true, otherwise it is expressed in a local world-oriented frame.

Reimplemented from tsid::tasks::TaskMotion.

◆ getConstraint()

const ConstraintBase & tsid::tasks::TaskTwoFramesEquality::getConstraint()const
overridevirtual

◆ getDesiredAcceleration()

const Vector & tsid::tasks::TaskTwoFramesEquality::getDesiredAcceleration()const
overridevirtual

Return the desired task acceleration (after applying the specified mask). The value is expressed in local frame is the local_frame flag is true, otherwise it is expressed in a local world-oriented frame.

Reimplemented from tsid::tasks::TaskMotion.

◆ Kd() [1/2]

const Vector & tsid::tasks::TaskTwoFramesEquality::Kd()const

◆ Kd() [2/2]

void tsid::tasks::TaskTwoFramesEquality::Kd(ConstRefVectorKp)

◆ Kp() [1/2]

const Vector & tsid::tasks::TaskTwoFramesEquality::Kp()const

◆ Kp() [2/2]

void tsid::tasks::TaskTwoFramesEquality::Kp(ConstRefVectorKp)

◆ position_error()

const Vector & tsid::tasks::TaskTwoFramesEquality::position_error()const
overridevirtual

Return the position tracking error (after applying the specified mask). The error is expressed in local frame is the local_frame flag is true, otherwise it is expressed in a local world-oriented frame.

Reimplemented from tsid::tasks::TaskMotion.

◆ setMask()

void tsid::tasks::TaskTwoFramesEquality::setMask(math::ConstRefVectormask)
overridevirtual

Reimplemented from tsid::tasks::TaskMotion.

◆ useLocalFrame()

void tsid::tasks::TaskTwoFramesEquality::useLocalFrame(boollocal_frame)

Specifies if the jacobian and desired acceloration should be expressed in the local frame or the local world-oriented frame.

Parameters
local_frameIf true, represent jacobian and acceloration in the local frame. If false, represent them in the local world-oriented frame.

◆ velocity_error()

const Vector & tsid::tasks::TaskTwoFramesEquality::velocity_error()const
overridevirtual

Return the velocity tracking error (after applying the specified mask). The error is expressed in local frame is the local_frame flag is true, otherwise it is expressed in a local world-oriented frame.

Reimplemented from tsid::tasks::TaskMotion.

Member Data Documentation

◆ Index

EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef math::Index tsid::tasks::TaskTwoFramesEquality::Index

◆ m_a_des

Vector tsid::tasks::TaskTwoFramesEquality::m_a_des
protected

◆ m_a_des_masked

Vector tsid::tasks::TaskTwoFramesEquality::m_a_des_masked
protected

◆ m_a_ref

Motion tsid::tasks::TaskTwoFramesEquality::m_a_ref
protected

◆ m_constraint

ConstraintEquality tsid::tasks::TaskTwoFramesEquality::m_constraint
protected

◆ m_drift

Motion tsid::tasks::TaskTwoFramesEquality::m_drift
protected

◆ m_drift_masked

Vector tsid::tasks::TaskTwoFramesEquality::m_drift_masked
protected

◆ m_frame_id1

Index tsid::tasks::TaskTwoFramesEquality::m_frame_id1
protected

◆ m_frame_id2

Index tsid::tasks::TaskTwoFramesEquality::m_frame_id2
protected

◆ m_frame_name1

std::string tsid::tasks::TaskTwoFramesEquality::m_frame_name1
protected

◆ m_frame_name2

std::string tsid::tasks::TaskTwoFramesEquality::m_frame_name2
protected

◆ m_J1

Matrix6x tsid::tasks::TaskTwoFramesEquality::m_J1
protected

◆ m_J1_rotated

Matrix6x tsid::tasks::TaskTwoFramesEquality::m_J1_rotated
protected

◆ m_J2

Matrix6x tsid::tasks::TaskTwoFramesEquality::m_J2
protected

◆ m_J2_rotated

Matrix6x tsid::tasks::TaskTwoFramesEquality::m_J2_rotated
protected

◆ m_Kd

Vector tsid::tasks::TaskTwoFramesEquality::m_Kd
protected

◆ m_Kp

Vector tsid::tasks::TaskTwoFramesEquality::m_Kp
protected

◆ m_p

Vector tsid::tasks::TaskTwoFramesEquality::m_p
protected

◆ m_p_error

Motion tsid::tasks::TaskTwoFramesEquality::m_p_error
protected

◆ m_p_error_masked_vec

Vector tsid::tasks::TaskTwoFramesEquality::m_p_error_masked_vec
protected

◆ m_p_error_vec

Vector tsid::tasks::TaskTwoFramesEquality::m_p_error_vec
protected

◆ m_p_ref

Vector tsid::tasks::TaskTwoFramesEquality::m_p_ref
protected

◆ m_v

Vector tsid::tasks::TaskTwoFramesEquality::m_v
protected

◆ m_v_error

Motion tsid::tasks::TaskTwoFramesEquality::m_v_error
protected

◆ m_v_error_masked_vec

Vector tsid::tasks::TaskTwoFramesEquality::m_v_error_masked_vec
protected

◆ m_v_error_vec

Vector tsid::tasks::TaskTwoFramesEquality::m_v_error_vec
protected

◆ m_v_ref

Motion tsid::tasks::TaskTwoFramesEquality::m_v_ref
protected

◆ m_v_ref_vec

Vector tsid::tasks::TaskTwoFramesEquality::m_v_ref_vec
protected

◆ m_wMl1

SE3 tsid::tasks::TaskTwoFramesEquality::m_wMl1
protected

◆ m_wMl2

SE3 tsid::tasks::TaskTwoFramesEquality::m_wMl2
protected

The documentation for this class was generated from the following files: