#include <task-two-frames-equality.hpp>

Inheritance diagram for tsid::tasks::TaskTwoFramesEquality:

Public Types
typedef math::ConstraintEquality	ConstraintEquality

typedef pinocchio::Data	Data

typedef pinocchio::Data::Matrix6x	Matrix6x

typedef pinocchio::Motion	Motion

typedef pinocchio::SE3	SE3

typedef trajectories::TrajectorySample	TrajectorySample

typedef math::Vector	Vector

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
const ConstraintBase &	compute (const double t, ConstRefVector q, ConstRefVector v, Data &data) override

int	dim () const override
	Return the dimension of the task. \info should be overloaded in the child class. More...

Index	frame_id1 () const

Index	frame_id2 () const

Vector	getAcceleration (ConstRefVector dv) const override

const ConstraintBase &	getConstraint () const override

const Vector &	getDesiredAcceleration () const override

const Vector &	Kd () const

void	Kd (ConstRefVector Kp)

const Vector &	Kp () const

void	Kp (ConstRefVector Kp)

const Vector &	position_error () const override

virtual void	setMask (math::ConstRefVector mask) override

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

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. More...

const Vector &	velocity_error () const override

Public Member Functions inherited from tsid::tasks::TaskMotion
virtual const Vector &	getMask () const

virtual const TrajectorySample &	getReference () const

virtual bool	hasMask ()

virtual const Vector &	position () const

virtual const Vector &	position_ref () const

	TaskMotion (const std::string &name, RobotWrapper &robot)

virtual const Vector &	velocity () const

virtual const Vector &	velocity_ref () const

Public Member Functions inherited from tsid::tasks::TaskBase
const std::string &	name () const

void	name (const std::string &name)

	TaskBase (const std::string &name, RobotWrapper &robot)

virtual	~TaskBase ()=default

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
Vector	m_a_des

Vector	m_a_des_masked

Motion	m_a_ref

ConstraintEquality	m_constraint

Motion	m_drift

Vector	m_drift_masked

Index	m_frame_id1

Index	m_frame_id2

std::string	m_frame_name1

std::string	m_frame_name2

Matrix6x	m_J1

Matrix6x	m_J1_rotated

Matrix6x	m_J2

Matrix6x	m_J2_rotated

Vector	m_Kd

Vector	m_Kp

Vector	m_p

Motion	m_p_error

Vector	m_p_error_masked_vec

Vector	m_p_error_vec

Vector	m_p_ref

Vector	m_v

Motion	m_v_error

Vector	m_v_error_masked_vec

Vector	m_v_error_vec

Motion	m_v_ref

Vector	m_v_ref_vec

SE3	m_wMl1

SE3	m_wMl2

Protected Attributes inherited from tsid::tasks::TaskMotion
Vector	m_dummy

Vector	m_mask

trajectories::TrajectorySample	TrajectorySample_dummy

Protected Attributes inherited from tsid::tasks::TaskBase
std::string	m_name

RobotWrapper &	m_robot
	Reference on the robot model. More...

Detailed Description

Definition at line 31 of file tasks/task-two-frames-equality.hpp.

Member Typedef Documentation

◆ ConstraintEquality

typedef math::ConstraintEquality tsid::tasks::TaskTwoFramesEquality::ConstraintEquality

Definition at line 38 of file tasks/task-two-frames-equality.hpp.

◆ Data

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

Definition at line 39 of file tasks/task-two-frames-equality.hpp.

◆ Matrix6x

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

Definition at line 40 of file tasks/task-two-frames-equality.hpp.

◆ Motion

typedef pinocchio::Motion tsid::tasks::TaskTwoFramesEquality::Motion

Definition at line 41 of file tasks/task-two-frames-equality.hpp.

◆ SE3

typedef pinocchio::SE3 tsid::tasks::TaskTwoFramesEquality::SE3

Definition at line 42 of file tasks/task-two-frames-equality.hpp.

◆ TrajectorySample

typedef trajectories::TrajectorySample tsid::tasks::TaskTwoFramesEquality::TrajectorySample

Definition at line 36 of file tasks/task-two-frames-equality.hpp.

◆ Vector

typedef math::Vector tsid::tasks::TaskTwoFramesEquality::Vector

Definition at line 37 of file tasks/task-two-frames-equality.hpp.

Constructor & Destructor Documentation

◆ TaskTwoFramesEquality()

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

Definition at line 29 of file src/tasks/task-two-frames-equality.cpp.

Member Function Documentation

◆ compute()

const ConstraintBase & tsid::tasks::TaskTwoFramesEquality::compute	(	const double	t,
		ConstRefVector	q,
		ConstRefVector	v,
		Data &	data
	)

overridevirtual

Implements tsid::tasks::TaskBase.

Definition at line 115 of file src/tasks/task-two-frames-equality.cpp.

◆ 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.

Definition at line 75 of file src/tasks/task-two-frames-equality.cpp.

◆ frame_id1()

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

Definition at line 107 of file src/tasks/task-two-frames-equality.cpp.

◆ frame_id2()

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

Definition at line 109 of file src/tasks/task-two-frames-equality.cpp.

◆ getAcceleration()

Vector tsid::tasks::TaskTwoFramesEquality::getAcceleration ( ConstRefVector dv ) 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.

Definition at line 103 of file src/tasks/task-two-frames-equality.cpp.

◆ getConstraint()

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

overridevirtual

Implements tsid::tasks::TaskBase.

Definition at line 111 of file src/tasks/task-two-frames-equality.cpp.

◆ 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.

Definition at line 99 of file src/tasks/task-two-frames-equality.cpp.

◆ Kd() [1/2]

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

Definition at line 79 of file src/tasks/task-two-frames-equality.cpp.

◆ Kd() [2/2]

void tsid::tasks::TaskTwoFramesEquality::Kd ( ConstRefVector Kp )

Definition at line 86 of file src/tasks/task-two-frames-equality.cpp.

◆ Kp() [1/2]

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

Definition at line 77 of file src/tasks/task-two-frames-equality.cpp.

◆ Kp() [2/2]

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

Definition at line 81 of file src/tasks/task-two-frames-equality.cpp.

◆ 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.

Definition at line 91 of file src/tasks/task-two-frames-equality.cpp.

◆ setMask()

void tsid::tasks::TaskTwoFramesEquality::setMask ( math::ConstRefVector mask )

overridevirtual

Reimplemented from tsid::tasks::TaskMotion.

Definition at line 65 of file src/tasks/task-two-frames-equality.cpp.

◆ useLocalFrame()

void tsid::tasks::TaskTwoFramesEquality::useLocalFrame ( bool local_frame )

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

Parameters

local_frame If 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.

Definition at line 95 of file src/tasks/task-two-frames-equality.cpp.