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

Inheritance diagram for tsid::tasks::TaskTwoFramesEquality:

Collaboration diagram for tsid::tasks::TaskTwoFramesEquality:

[legend]

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

const ConstraintBase &	compute (const double t, ConstRefVector q, ConstRefVector v, Data &data) override

const ConstraintBase &	getConstraint () const override

const Vector &	getDesiredAcceleration () const override

Vector	getAcceleration (ConstRefVector dv) const override

virtual void	setMask (math::ConstRefVector mask) override

const Vector &	position_error () const override

const Vector &	velocity_error () const override

const Vector &	Kp () const

const Vector &	Kd () 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. More...

Public Member Functions inherited from tsid::tasks::TaskMotion
	TaskMotion (const std::string &name, RobotWrapper &robot)

virtual const TrajectorySample &	getReference () const

virtual const Vector &	position () const

virtual const Vector &	velocity () const

virtual const Vector &	position_ref () const

virtual const Vector &	velocity_ref () const

virtual const Vector &	getMask () 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

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

Member Typedef Documentation

◆ ConstraintEquality

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

◆ Data

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

◆ Matrix6x

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

◆ Motion

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

◆ SE3

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

◆ TrajectorySample

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

◆ Vector

typedef math::Vector tsid::tasks::TaskTwoFramesEquality::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 double	t,
		ConstRefVector	q,
		ConstRefVector	v,
		Data &	data
	)

overridevirtual

Implements tsid::tasks::TaskBase.

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

◆ getConstraint()

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

overridevirtual

Implements tsid::tasks::TaskBase.

◆ 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 ( ConstRefVector Kp )

◆ Kp() [1/2]

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

◆ Kp() [2/2]

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

◆ 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::ConstRefVector mask )

overridevirtual

Reimplemented from tsid::tasks::TaskMotion.

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

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:

include/tsid/tasks/task-two-frames-equality.hpp
src/tasks/task-two-frames-equality.cpp

Public Types

Public Member Functions

Public Attributes

Protected Attributes

Member Typedef Documentation

◆ ConstraintEquality

◆ Data

◆ Matrix6x

◆ Motion

◆ SE3

◆ TrajectorySample

◆ Vector

Constructor & Destructor Documentation

◆ TaskTwoFramesEquality()

Member Function Documentation

◆ compute()

◆ dim()

◆ frame_id1()

◆ frame_id2()

◆ getAcceleration()

◆ getConstraint()

◆ getDesiredAcceleration()

◆ Kd() [1/2]

◆ Kd() [2/2]

◆ Kp() [1/2]

◆ Kp() [2/2]

◆ position_error()

◆ setMask()

◆ useLocalFrame()

◆ velocity_error()

Member Data Documentation

◆ Index

◆ m_a_des

◆ m_a_des_masked

◆ m_a_ref

◆ m_constraint

◆ m_drift

◆ m_drift_masked

◆ m_frame_id1

◆ m_frame_id2

◆ m_frame_name1

◆ m_frame_name2

◆ m_J1

◆ m_J1_rotated

◆ m_J2

◆ m_J2_rotated

◆ m_Kd

◆ m_Kp

◆ m_p

◆ m_p_error

◆ m_p_error_masked_vec

◆ m_p_error_vec

◆ m_p_ref

◆ m_v

◆ m_v_error

◆ m_v_error_masked_vec

◆ m_v_error_vec

◆ m_v_ref

◆ m_v_ref_vec

◆ m_wMl1

◆ m_wMl2