1717
1818/* -- MaaL --- */
1919#include < dynamic-graph/linear-algebra.h>
20- namespace dg = dynamicgraph;
20+
2121/* SOT */
2222#include " sot/core/api.hh"
2323#include " sot/core/periodic-call.hh"
@@ -55,10 +55,10 @@ public:
5555 };
5656
5757protected:
58- dg ::Vector state_;
59- dg ::Vector velocity_;
58+ dynamicgraph ::Vector state_;
59+ dynamicgraph ::Vector velocity_;
6060 bool sanityCheck_;
61- dg ::Vector vel_control_;
61+ dynamicgraph ::Vector vel_control_;
6262 ControlInput controlInputType_;
6363 bool withForceSignals[4 ];
6464 PeriodicCall periodicCallBefore_;
@@ -81,9 +81,9 @@ public:
8181 virtual ~Device ();
8282
8383 virtual void setStateSize (const unsigned int &size);
84- virtual void setState (const dg ::Vector &st);
84+ virtual void setState (const dynamicgraph ::Vector &st);
8585 void setVelocitySize (const unsigned int &size);
86- virtual void setVelocity (const dg ::Vector &vel);
86+ virtual void setVelocity (const dynamicgraph ::Vector &vel);
8787 virtual void setSecondOrderIntegration ();
8888 virtual void setNoIntegration ();
8989 virtual void setControlInputType (const std::string &cit);
@@ -107,20 +107,20 @@ public: /* --- DISPLAY --- */
107107 }
108108
109109public: /* --- 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;
113113
114114 // / \name Device current state.
115115 // / \{
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;
118118 dynamicgraph::Signal<MatrixRotation, int > attitudeSOUT;
119119 /* ! \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;
122122 /* ! \brief The ZMP reference send by the previous controller. */
123- dynamicgraph::Signal<dg ::Vector, int > ZMPPreviousControllerSOUT;
123+ dynamicgraph::Signal<dynamicgraph ::Vector, int > ZMPPreviousControllerSOUT;
124124 // / \}
125125
126126 // / \name Real robot current state
@@ -129,19 +129,19 @@ public: /* --- SIGNALS --- */
129129 // / does *not* match the state control input signal.
130130 // / \{
131131 // / Motor positions
132- dynamicgraph::Signal<dg ::Vector, int > robotState_;
132+ dynamicgraph::Signal<dynamicgraph ::Vector, int > robotState_;
133133 // / Motor velocities
134- dynamicgraph::Signal<dg ::Vector, int > robotVelocity_;
134+ dynamicgraph::Signal<dynamicgraph ::Vector, int > robotVelocity_;
135135 // / The force torque sensors
136- dynamicgraph::Signal<dg ::Vector, int > *forcesSOUT[4 ];
136+ dynamicgraph::Signal<dynamicgraph ::Vector, int > *forcesSOUT[4 ];
137137 // / Motor torques
138138 // / \todo why pseudo ?
139- dynamicgraph::Signal<dg ::Vector, int > pseudoTorqueSOUT;
139+ dynamicgraph::Signal<dynamicgraph ::Vector, int > pseudoTorqueSOUT;
140140 // / \}
141141
142142protected:
143143 // / 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,
145145 double dt);
146146 // / Store Position of free flyer joint
147147 MatrixHomogeneous ffPose_;
@@ -164,13 +164,13 @@ protected:
164164 const MatrixHomogeneous &freeFlyerPose () const ;
165165
166166public:
167- virtual void setRoot (const dg ::Matrix &root);
167+ virtual void setRoot (const dynamicgraph ::Matrix &root);
168168
169169 virtual void setRoot (const MatrixHomogeneous &worldMwaist);
170170
171171private:
172172 // Intermediate variable to avoid dynamic allocation
173- dg ::Vector forceZero6;
173+ dynamicgraph ::Vector forceZero6;
174174};
175175} // namespace sot
176176} // namespace dynamicgraph
0 commit comments