sot-core
4.10.1
Hierarchical task solver plug-in for dynamic-graph.
|
Go to the documentation of this file.
9 #ifndef __SOT_FEATURE_POSE_HH__
10 #define __SOT_FEATURE_POSE_HH__
61 template <Representation_t representation = R3xSO3Representation>
66 virtual const std::string &
getClassName(
void)
const {
return CLASS_NAME; }
72 dynamicgraph::SignalPtr<MatrixHomogeneous, int> oMja;
75 dynamicgraph::SignalPtr<MatrixHomogeneous, int>
jaMfa;
77 dynamicgraph::SignalPtr<MatrixHomogeneous, int>
oMjb;
79 dynamicgraph::SignalPtr<MatrixHomogeneous, int>
jbMfb;
81 dynamicgraph::SignalPtr<Matrix, int>
jaJja;
83 dynamicgraph::SignalPtr<Matrix, int>
jbJjb;
86 dynamicgraph::SignalPtr<MatrixHomogeneous, int>
faMfbDes;
95 SignalTimeDependent<MatrixHomogeneous, int> faMfb;
120 virtual unsigned int &getDimension(
unsigned int &dim,
int time);
123 virtual dynamicgraph::Vector &computeError(dynamicgraph::Vector &res,
131 virtual dynamicgraph::Vector &computeErrorDot(dynamicgraph::Vector &res,
139 virtual dynamicgraph::Matrix &computeJacobian(dynamicgraph::Matrix &res,
153 virtual void display(std::ostream &os)
const;
156 void servoCurrentPosition(
const int &time);
166 template <
typename T>
169 const Vector &faNufafbDes);
174 #if __cplusplus >= 201103L
185 #endif // #ifndef __SOT_FEATURE_POSE_HH__
dynamicgraph::SignalPtr< Matrix, int > jaJja
Jacobian of the input Joint A, expressed in Joint A
Definition: feature-pose.hh:81
#define DECLARE_NO_REFERENCE
Definition: feature-abstract.hh:275
const SOT_CORE_EXPORT Flags FLAG_LINE_3
dynamicgraph::SignalPtr< Matrix, int > jbJjb
Jacobian of the input Joint B, expressed in Joint B
Definition: feature-pose.hh:83
@ SE3Representation
Definition: feature-pose.hh:29
static Flags selectRY(void)
Definition: feature-pose.hh:147
Eigen::Transform< double, 3, Eigen::Affine > SOT_CORE_EXPORT MatrixHomogeneous
Definition: matrix-geometry.hh:74
SignalTimeDependent< dynamicgraph::Matrix, int > jacobianSOUT
Jacobian of the error wrt the robot state: .
Definition: feature-abstract.hh:192
SignalTimeDependent< dynamicgraph::Vector, int > errorSOUT
This signal returns the error between the desired value and the current value : .
Definition: feature-abstract.hh:184
Definition: abstract-sot-external-interface.hh:17
const SOT_CORE_EXPORT Flags FLAG_LINE_5
static Flags selectTranslation(void)
Definition: feature-pose.hh:150
static Flags selectY(void)
Definition: feature-pose.hh:144
SignalTimeDependent< Vector7, int > q_faMfbDes
Definition: feature-pose.hh:104
static Flags selectZ(void)
Definition: feature-pose.hh:145
static Flags selectRZ(void)
Definition: feature-pose.hh:148
SignalTimeDependent< Vector7, int > q_faMfb
Definition: feature-pose.hh:100
dynamicgraph::SignalPtr< Vector, int > faNufafbDes
Definition: feature-pose.hh:89
This class gives the abstract definition of a feature.
Definition: feature-abstract.hh:75
@ R3xSO3Representation
Definition: feature-pose.hh:29
static Flags selectX(void)
Definition: feature-pose.hh:143
dynamicgraph::SignalPtr< MatrixHomogeneous, int > jbMfb
Input pose of Frame B wrt to Joint B.
Definition: feature-pose.hh:79
dynamicgraph::SignalPtr< MatrixHomogeneous, int > jaMfa
Input pose of Frame A wrt to Joint A.
Definition: feature-pose.hh:75
FeaturePose< R3xSO3Representation > FeaturePose_t
Definition: feature-pose.hh:179
Feature that controls the relative (or absolute) pose between two frames A (or world) and B.
Definition: feature-pose.hh:62
static Flags selectRotation(void)
Definition: feature-pose.hh:151
FeaturePose< SE3Representation > FeaturePoseSE3_t
Definition: feature-pose.hh:180
Vector6d convertVelocity(const MatrixHomogeneous &M, const MatrixHomogeneous &Mdes, const Vector &faNufafbDes)
static const std::string CLASS_NAME
Definition: feature-pose.hh:65
virtual const std::string & getClassName(void) const
Returns the name class.
Definition: feature-pose.hh:66
Representation_t
Enum used to specify what difference operation is used in FeaturePose.
Definition: feature-pose.hh:29
static Flags selectRX(void)
Definition: feature-pose.hh:146
const SOT_CORE_EXPORT Flags FLAG_LINE_4
#define SOT_CORE_DLLAPI
Definition: config.hh:64
Eigen::Matrix< double, 7, 1 > SOT_CORE_EXPORT Vector7
Definition: matrix-geometry.hh:83
const SOT_CORE_EXPORT Flags FLAG_LINE_6
SignalPtr< Flags, int > selectionSIN
This vector specifies which dimension are used to perform the computation. For instance let us assume...
Definition: feature-abstract.hh:172
dynamicgraph::SignalPtr< MatrixHomogeneous, int > oMjb
Input pose of Joint B wrt to world frame.
Definition: feature-pose.hh:77
const SOT_CORE_EXPORT Flags FLAG_LINE_2
dynamicgraph::SignalPtr< MatrixHomogeneous, int > faMfbDes
The desired pose of Frame B wrt to Frame A.
Definition: feature-pose.hh:86
const SOT_CORE_EXPORT Flags FLAG_LINE_1