sot-core
4.11.8
Hierarchical task solver plug-in for dynamic-graph.
|
#include <sot/core/feature-posture.hh>
Public Types | |
typedef dynamicgraph::SignalPtr< dynamicgraph::Vector, int > | signalIn_t |
typedef dynamicgraph::SignalTimeDependent< dynamicgraph::Vector, int > | signalOut_t |
Public Member Functions | |
FeaturePosture (const std::string &name) | |
virtual | ~FeaturePosture () |
virtual unsigned int & | getDimension (unsigned int &res, int) |
Verbose method. More... | |
void | selectDof (unsigned dofId, bool control) |
Public Member Functions inherited from dynamicgraph::sot::FeatureAbstract | |
virtual const std::string & | getClassName (void) const |
Returns the name class. More... | |
void | featureRegistration (void) |
Register the feature in the stack of tasks. More... | |
void | initCommands (void) |
FeatureAbstract (const std::string &name) | |
Default constructor: the name of the class should be given. More... | |
virtual | ~FeatureAbstract (void) |
Default destructor. More... | |
unsigned int | getDimension (int time) |
Short method. More... | |
unsigned int | getDimension (void) const |
Shortest method. More... | |
virtual void | setReference (FeatureAbstract *sdes)=0 |
virtual void | unsetReference (void) |
virtual const FeatureAbstract * | getReferenceAbstract (void) const =0 |
virtual FeatureAbstract * | getReferenceAbstract (void)=0 |
virtual bool | isReferenceSet (void) const |
virtual void | addDependenciesFromReference (void)=0 |
virtual void | removeDependenciesFromReference (void)=0 |
void | setReferenceByName (const std::string &name) |
std::string | getReferenceByName (void) const |
virtual std::ostream & | writeGraph (std::ostream &os) const |
This method write a graph description on the file named FileName. More... | |
virtual SignalTimeDependent< dynamicgraph::Vector, int > & | getErrorDot () |
Public Attributes | |
DECLARE_NO_REFERENCE | |
Public Attributes inherited from dynamicgraph::sot::FeatureAbstract | |
SignalPtr< Flags, int > | selectionSIN |
This vector specifies which dimension are used to perform the computation. For instance let us assume that the feature is a 3D point. If only the Y-axis should be used for computing error, activation and Jacobian, then the vector to specify is \( [ 0 1 0] \). More... | |
SignalPtr< dynamicgraph::Vector, int > | errordotSIN |
Derivative of the reference value. More... | |
SignalTimeDependent< dynamicgraph::Vector, int > | errorSOUT |
This signal returns the error between the desired value and the current value : \( E(t) = {\bf s}(t) - {\bf s}^*(t)\). More... | |
SignalTimeDependent< dynamicgraph::Vector, int > | errordotSOUT |
Derivative of the error with respect to time: \( \frac{\partial e}{\partial t} = - \frac{d{\bf s}^*}{dt} \). More... | |
SignalTimeDependent< dynamicgraph::Matrix, int > | jacobianSOUT |
Jacobian of the error wrt the robot state: \( J = \frac{\partial {\bf s}}{\partial {\bf q}}\). More... | |
SignalTimeDependent< unsigned int, int > | dimensionSOUT |
Returns the dimension of the feature as an output signal. More... | |
Protected Member Functions | |
virtual dynamicgraph::Vector & | computeError (dynamicgraph::Vector &res, int) |
Compute the error between the desired feature and the current value of the feature measured or deduced from the robot state. More... | |
virtual dynamicgraph::Matrix & | computeJacobian (dynamicgraph::Matrix &res, int) |
Compute the Jacobian of the error according the robot state. More... | |
virtual dynamicgraph::Vector & | computeErrorDot (dynamicgraph::Vector &res, int time) |
Protected Attributes | |
signalIn_t | state_ |
signalIn_t | posture_ |
signalIn_t | postureDot_ |
signalOut_t | error_ |
Friends | |
class | SelectDof |
Additional Inherited Members | |
Static Public Attributes inherited from dynamicgraph::sot::FeatureAbstract | |
static const std::string | CLASS_NAME |
Store the name of the class. More... | |
Feature that observes the posture of the robot, ie whose Jacobian is the identity, or slices of the identity. This feature can be exactly obtained with a generic posture, given the identity matrix as the input Jacobian, the identity matrix. It is even prefereable, as the reference value is then given by a signal, which can be reevalutated at each iteration, for example to track a reference trajectory in the configuration space. See for example the toFlag python function in the sot-dyninv module to nicely selec the posture DOF.
typedef dynamicgraph::SignalPtr<dynamicgraph::Vector, int> dynamicgraph::sot::FeaturePosture::signalIn_t |
typedef dynamicgraph::SignalTimeDependent<dynamicgraph::Vector, int> dynamicgraph::sot::FeaturePosture::signalOut_t |
|
explicit |
|
virtual |
|
protectedvirtual |
Compute the error between the desired feature and the current value of the feature measured or deduced from the robot state.
Implements dynamicgraph::sot::FeatureAbstract.
|
protectedvirtual |
Callback for signal errordotSOUT
Copy components of the input signal errordotSIN defined by selection flag selectionSIN.
Reimplemented from dynamicgraph::sot::FeatureAbstract.
|
protectedvirtual |
Compute the Jacobian of the error according the robot state.
Implements dynamicgraph::sot::FeatureAbstract.
|
virtual |
Verbose method.
Implements dynamicgraph::sot::FeatureAbstract.
void dynamicgraph::sot::FeaturePosture::selectDof | ( | unsigned | dofId, |
bool | control | ||
) |
|
friend |
dynamicgraph::sot::FeaturePosture::DECLARE_NO_REFERENCE |
|
protected |
|
protected |
|
protected |
|
protected |