scl::CTaskOpPos Class Reference

#include <CTaskOpPos.hpp>

Inheritance diagram for scl::CTaskOpPos:

Collaboration diagram for scl::CTaskOpPos:

Public Member Functions
virtual bool	computeServo (const SRobotSensors *arg_sensors)
virtual bool	computeModel (const SRobotSensors *arg_sensors)
virtual STaskBase *	getTaskData ()
virtual bool	setGoalPos (const Eigen::VectorXd &arg_goal)
virtual bool	setGoalVel (const Eigen::VectorXd &arg_goal)
virtual bool	setGoalAcc (const Eigen::VectorXd &arg_goal)
virtual bool	getGoalPos (Eigen::VectorXd &arg_goal) const
virtual bool	getGoalVel (Eigen::VectorXd &arg_goal) const
virtual bool	getGoalAcc (Eigen::VectorXd &arg_goal) const
virtual bool	getPos (Eigen::VectorXd &arg_pos) const
virtual bool	getVel (Eigen::VectorXd &arg_vel) const
virtual bool	getAcc (Eigen::VectorXd &arg_acc) const
sBool	achievedGoalPos ()
void	setFlagComputeOpPosGravity (sBool arg_compute_grav)
	CTaskOpPos ()
virtual	~CTaskOpPos ()
virtual bool	init (STaskBase *arg_task_data, CDynamicsBase *arg_dynamics)
virtual void	reset ()
virtual sBool	hasBeenInit ()
virtual sBool	setActivated (sBool arg_activate)
virtual sBool	hasBeenActivated ()

Protected Attributes
STaskOpPos *	data_
Eigen::VectorXd	tmp1
Eigen::VectorXd	tmp2
Eigen::ColPivHouseholderQR < Eigen::Matrix3d >	qr_
sBool	lambda_inv_singular_
Eigen::JacobiSVD< Eigen::Matrix3d >	svd_
Eigen::Matrix3d	singular_values_
sBool	flag_compute_gravity_
sBool	has_been_init_
CDynamicsBase *	dynamics_

Detailed Description

Computes the operational space forces for a single 3-d (x,y,z) goal point Euclidean task

It computes:

1. The task model (computes, mass, jacobian, inv jacobian, coriolis, centrifugal and gravity matrices/vectors).
2. The task servo (computes the dynamically decoupled task forces and the torques. uses the task model to do so).

Constructor & Destructor Documentation

scl::CTaskOpPos::CTaskOpPos

(

)

Default constructor : Does nothing

virtual scl::CTaskOpPos::~CTaskOpPos ( )

inlinevirtual

Default destructor : Does nothing.

Member Function Documentation

bool scl::CTaskOpPos::achievedGoalPos

(

)

Whether the task has achieved its goal position.

bool scl::CTaskOpPos::computeModel ( const SRobotSensors *  arg_sensors )

virtual

Computes the dynamics (task model) Assumes that the data_->model_.gc_model_ has been updated.

Implements scl::CTaskBase.

Reimplemented in scl::CTaskOpPosNoGravity.

bool scl::CTaskOpPos::computeServo ( const SRobotSensors *  arg_sensors )

virtual

Computes the task torques

Implements scl::CTaskBase.

Reimplemented in scl::CTaskOpPosNoGravity.

virtual bool scl::CTaskOpPos::getAcc ( Eigen::VectorXd &  arg_acc ) const

inlinevirtual

Gets the current acceleration. Returns false if not supported by task.

Reimplemented from scl::CTaskBase.

virtual bool scl::CTaskOpPos::getGoalAcc ( Eigen::VectorXd &  arg_goal ) const

inlinevirtual

Gets the current goal acceleration. Returns false if not supported by task.

Reimplemented from scl::CTaskBase.

virtual bool scl::CTaskOpPos::getGoalPos ( Eigen::VectorXd &  arg_goal ) const

inlinevirtual

Gets the current goal position. Returns false if not supported by task.

Reimplemented from scl::CTaskBase.

virtual bool scl::CTaskOpPos::getGoalVel ( Eigen::VectorXd &  arg_goal ) const

inlinevirtual

Gets the current goal velocity. Returns false if not supported by task.

Reimplemented from scl::CTaskBase.

virtual bool scl::CTaskOpPos::getPos ( Eigen::VectorXd &  arg_pos ) const

inlinevirtual

Gets the current position. Returns false if not supported by task.

Reimplemented from scl::CTaskBase.

STaskBase * scl::CTaskOpPos::getTaskData ( )

virtual

Return this task controller's task data structure.

Implements scl::CTaskBase.

Reimplemented in scl::CTaskOpPosNoGravity.

virtual bool scl::CTaskOpPos::getVel ( Eigen::VectorXd &  arg_vel ) const

inlinevirtual

Gets the current velocity. Returns false if not supported by task.

Reimplemented from scl::CTaskBase.

virtual sBool scl::CTaskBase::hasBeenActivated ( )

inlinevirtualinherited

Activated = All dynamic parameters and data structures are up to date and task is actively contributing to a controller.

virtual sBool scl::CTaskBase::hasBeenInit ( )

inlinevirtualinherited

Initialized = All static parameters are set and data structures are up to date. Ready to contribute to a controller.

bool scl::CTaskOpPos::init ( STaskBase *  arg_task_data, CDynamicsBase *  arg_dynamics  )

virtual

Initializes the task object. Required to set output gc force dofs

Implements scl::CTaskBase.

Reimplemented in scl::CTaskOpPosNoGravity.

void scl::CTaskOpPos::reset ( )

virtual

Resets the task by removing its data. NOTE : Does not deallocate its data structure

Implements scl::CTaskBase.

Reimplemented in scl::CTaskOpPosNoGravity.

virtual sBool scl::CTaskBase::setActivated ( sBool  arg_activate )

inlinevirtualinherited

Activated = All dynamic parameters and data structures are up to date and task is actively contributing to a controller.

Set to true/false during runtime to activate/deactivate task.

Returns : success/failure

bool scl::CTaskOpPos::setGoalAcc ( const Eigen::VectorXd &  arg_goal )

virtual

Sets the current goal acceleration

Reimplemented from scl::CTaskBase.

bool scl::CTaskOpPos::setGoalPos ( const Eigen::VectorXd &  arg_goal )

virtual

Sets the current goal position

Reimplemented from scl::CTaskBase.

bool scl::CTaskOpPos::setGoalVel ( const Eigen::VectorXd &  arg_goal )

virtual

Sets the current goal velocity

Reimplemented from scl::CTaskBase.

Member Data Documentation

STaskOpPos* scl::CTaskOpPos::data_

protected

The actual data structure for this computational object

CDynamicsBase* scl::CTaskBase::dynamics_

protectedinherited

A Dynamics model required to compute the task's dynamics

sBool scl::CTaskBase::has_been_init_

protectedinherited

Initialized = All static parameters are set and data structures are up to date.

Set to true in init()

sBool scl::CTaskOpPos::lambda_inv_singular_

protected

True when the lambda_inv matrix turns singular.

Eigen::ColPivHouseholderQR<Eigen::Matrix3d> scl::CTaskOpPos::qr_

protected

For inverting the lambda matrix (when it gets singular)

Eigen::JacobiSVD<Eigen::Matrix3d > scl::CTaskOpPos::svd_

protected

For inverting the operational space inertia matrix near singularities. 3x3 for operational point tasks.

Eigen::VectorXd scl::CTaskOpPos::tmp1

protected

Temporary variables

---

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

• /home/samir/Code/control/scl.git/src/scl/control/task/tasks/CTaskOpPos.hpp
• /home/samir/Code/control/scl.git/src/scl/control/task/tasks/CTaskOpPos.cpp