17
17
18
18
/* -- MaaL --- */
19
19
#include < dynamic-graph/linear-algebra.h>
20
- namespace dg = dynamicgraph;
20
+
21
21
/* SOT */
22
22
#include " sot/core/api.hh"
23
23
#include " sot/core/periodic-call.hh"
@@ -55,10 +55,10 @@ public:
55
55
};
56
56
57
57
protected:
58
- dg ::Vector state_;
59
- dg ::Vector velocity_;
58
+ dynamicgraph ::Vector state_;
59
+ dynamicgraph ::Vector velocity_;
60
60
bool sanityCheck_;
61
- dg ::Vector vel_control_;
61
+ dynamicgraph ::Vector vel_control_;
62
62
ControlInput controlInputType_;
63
63
bool withForceSignals[4 ];
64
64
PeriodicCall periodicCallBefore_;
@@ -81,9 +81,9 @@ public:
81
81
virtual ~Device ();
82
82
83
83
virtual void setStateSize (const unsigned int &size);
84
- virtual void setState (const dg ::Vector &st);
84
+ virtual void setState (const dynamicgraph ::Vector &st);
85
85
void setVelocitySize (const unsigned int &size);
86
- virtual void setVelocity (const dg ::Vector &vel);
86
+ virtual void setVelocity (const dynamicgraph ::Vector &vel);
87
87
virtual void setSecondOrderIntegration ();
88
88
virtual void setNoIntegration ();
89
89
virtual void setControlInputType (const std::string &cit);
@@ -107,20 +107,20 @@ public: /* --- DISPLAY --- */
107
107
}
108
108
109
109
public: /* --- SIGNALS --- */
110
- dynamicgraph::SignalPtr<dg ::Vector, int > controlSIN;
111
- dynamicgraph::SignalPtr<dg ::Vector, int > attitudeSIN;
112
- dynamicgraph::SignalPtr<dg ::Vector, int > zmpSIN;
110
+ dynamicgraph::SignalPtr<dynamicgraph ::Vector, int > controlSIN;
111
+ dynamicgraph::SignalPtr<dynamicgraph ::Vector, int > attitudeSIN;
112
+ dynamicgraph::SignalPtr<dynamicgraph ::Vector, int > zmpSIN;
113
113
114
114
// / \name Device current state.
115
115
// / \{
116
- dynamicgraph::Signal<dg ::Vector, int > stateSOUT;
117
- dynamicgraph::Signal<dg ::Vector, int > velocitySOUT;
116
+ dynamicgraph::Signal<dynamicgraph ::Vector, int > stateSOUT;
117
+ dynamicgraph::Signal<dynamicgraph ::Vector, int > velocitySOUT;
118
118
dynamicgraph::Signal<MatrixRotation, int > attitudeSOUT;
119
119
/* ! \brief The current state of the robot from the command viewpoint. */
120
- dynamicgraph::Signal<dg ::Vector, int > motorcontrolSOUT;
121
- dynamicgraph::Signal<dg ::Vector, int > previousControlSOUT;
120
+ dynamicgraph::Signal<dynamicgraph ::Vector, int > motorcontrolSOUT;
121
+ dynamicgraph::Signal<dynamicgraph ::Vector, int > previousControlSOUT;
122
122
/* ! \brief The ZMP reference send by the previous controller. */
123
- dynamicgraph::Signal<dg ::Vector, int > ZMPPreviousControllerSOUT;
123
+ dynamicgraph::Signal<dynamicgraph ::Vector, int > ZMPPreviousControllerSOUT;
124
124
// / \}
125
125
126
126
// / \name Real robot current state
@@ -129,19 +129,19 @@ public: /* --- SIGNALS --- */
129
129
// / does *not* match the state control input signal.
130
130
// / \{
131
131
// / Motor positions
132
- dynamicgraph::Signal<dg ::Vector, int > robotState_;
132
+ dynamicgraph::Signal<dynamicgraph ::Vector, int > robotState_;
133
133
// / Motor velocities
134
- dynamicgraph::Signal<dg ::Vector, int > robotVelocity_;
134
+ dynamicgraph::Signal<dynamicgraph ::Vector, int > robotVelocity_;
135
135
// / The force torque sensors
136
- dynamicgraph::Signal<dg ::Vector, int > *forcesSOUT[4 ];
136
+ dynamicgraph::Signal<dynamicgraph ::Vector, int > *forcesSOUT[4 ];
137
137
// / Motor torques
138
138
// / \todo why pseudo ?
139
- dynamicgraph::Signal<dg ::Vector, int > pseudoTorqueSOUT;
139
+ dynamicgraph::Signal<dynamicgraph ::Vector, int > pseudoTorqueSOUT;
140
140
// / \}
141
141
142
142
protected:
143
143
// / Compute roll pitch yaw angles of freeflyer joint.
144
- void integrateRollPitchYaw (dg ::Vector &state, const dg ::Vector &control,
144
+ void integrateRollPitchYaw (dynamicgraph ::Vector &state, const dynamicgraph ::Vector &control,
145
145
double dt);
146
146
// / Store Position of free flyer joint
147
147
MatrixHomogeneous ffPose_;
@@ -164,13 +164,13 @@ protected:
164
164
const MatrixHomogeneous &freeFlyerPose () const ;
165
165
166
166
public:
167
- virtual void setRoot (const dg ::Matrix &root);
167
+ virtual void setRoot (const dynamicgraph ::Matrix &root);
168
168
169
169
virtual void setRoot (const MatrixHomogeneous &worldMwaist);
170
170
171
171
private:
172
172
// Intermediate variable to avoid dynamic allocation
173
- dg ::Vector forceZero6;
173
+ dynamicgraph ::Vector forceZero6;
174
174
};
175
175
} // namespace sot
176
176
} // namespace dynamicgraph
0 commit comments