10 #ifndef __SOT_ANGLE_ESTIMATOR_H__ 11 #define __SOT_ANGLE_ESTIMATOR_H__ 17 #if defined(angle_estimator_EXPORTS) 18 #define SOTANGLEESTIMATOR_EXPORT __declspec(dllexport) 20 #define SOTANGLEESTIMATOR_EXPORT __declspec(dllimport) 23 #define SOTANGLEESTIMATOR_EXPORT 31 #include <dynamic-graph/linear-algebra.h> 34 #include <dynamic-graph/entity.h> 35 #include <dynamic-graph/signal-ptr.h> 36 #include <dynamic-graph/signal-time-dependent.h> 38 #include <sot/core/matrix-geometry.hh> 54 virtual const std::string&
getClassName(
void)
const {
return CLASS_NAME; }
61 dg::SignalPtr<MatrixRotation, int>
63 dg::SignalPtr<MatrixHomogeneous, int>
65 dg::SignalPtr<MatrixHomogeneous, int>
67 dg::SignalPtr<MatrixHomogeneous, int>
69 dg::SignalTimeDependent<dynamicgraph::Vector, int>
72 dg::SignalTimeDependent<MatrixRotation, int>
74 dg::SignalTimeDependent<MatrixRotation, int>
76 dg::SignalTimeDependent<MatrixRotation, int>
78 dg::SignalTimeDependent<MatrixHomogeneous, int>
80 dg::SignalTimeDependent<dynamicgraph::Vector, int>
84 dg::SignalPtr<dynamicgraph::Vector, int>
qdotSIN;
85 dg::SignalTimeDependent<dynamicgraph::Vector, int>
xff_dotSOUT;
86 dg::SignalTimeDependent<dynamicgraph::Vector, int>
qdotSOUT;
89 dynamicgraph::Vector& computeAngles(dynamicgraph::Vector& res,
91 MatrixRotation& computeFlexibilityFromAngles(MatrixRotation& res,
93 MatrixRotation& computeDriftFromAngles(MatrixRotation& res,
const int& time);
94 MatrixRotation& computeSensorWorldRotation(MatrixRotation& res,
96 MatrixRotation& computeWaistWorldRotation(MatrixRotation& res,
98 MatrixHomogeneous& computeWaistWorldPosition(MatrixHomogeneous& res,
100 dynamicgraph::Vector& computeWaistWorldPoseRPY(dynamicgraph::Vector& res,
102 dynamicgraph::Vector& compute_xff_dotSOUT(dynamicgraph::Vector& res,
104 dynamicgraph::Vector& compute_qdotSOUT(dynamicgraph::Vector& res,
118 #endif // #ifndef __SOT_ANGLE_ESTIMATOR_H__ dg::SignalTimeDependent< MatrixRotation, int > flexibilitySOUT
Definition: angle-estimator.h:71
bool fromSensor() const
Definition: angle-estimator.h:109
dg::SignalTimeDependent< dynamicgraph::Vector, int > qdotSOUT
Definition: angle-estimator.h:86
dg::SignalPtr< MatrixRotation, int > sensorWorldRotationSIN
Definition: angle-estimator.h:62
dg::SignalTimeDependent< dynamicgraph::Vector, int > anglesSOUT
Definition: angle-estimator.h:70
dg::SignalTimeDependent< MatrixHomogeneous, int > waistWorldPositionSOUT
Definition: angle-estimator.h:79
virtual const std::string & getClassName(void) const
Definition: angle-estimator.h:54
dg::SignalPtr< dynamicgraph::Vector, int > qdotSIN
Definition: angle-estimator.h:84
dg::SignalTimeDependent< MatrixRotation, int > driftSOUT
Definition: angle-estimator.h:73
static const std::string CLASS_NAME
Definition: angle-estimator.h:53
dg::SignalTimeDependent< MatrixRotation, int > sensorWorldRotationSOUT
Definition: angle-estimator.h:75
dg::SignalPtr< MatrixHomogeneous, int > contactWorldPositionSIN
Definition: angle-estimator.h:66
#define SOTANGLEESTIMATOR_EXPORT
Definition: angle-estimator.h:23
dg::SignalTimeDependent< dynamicgraph::Vector, int > waistWorldPoseRPYSOUT
Definition: angle-estimator.h:81
dg::SignalTimeDependent< MatrixRotation, int > waistWorldRotationSOUT
Definition: angle-estimator.h:77
dg::SignalPtr< MatrixHomogeneous, int > contactEmbeddedPositionSIN
Definition: angle-estimator.h:68
dg::SignalPtr< dynamicgraph::Matrix, int > jacobianSIN
Definition: angle-estimator.h:83
dg::SignalTimeDependent< dynamicgraph::Vector, int > xff_dotSOUT
Definition: angle-estimator.h:85
void fromSensor(const bool &fs)
Definition: angle-estimator.h:108
dg::SignalPtr< MatrixHomogeneous, int > sensorEmbeddedPositionSIN
Definition: angle-estimator.h:64
Definition: angle-estimator.h:43
Definition: angle-estimator.h:51