@@ -107,7 +107,7 @@ SoTTestDevice::SoTTestDevice(std::string RobotName)
107107SoTTestDevice::~SoTTestDevice () {}
108108
109109void SoTTestDevice::setSensorsForce (map<string, dgsot::SensorValues> &SensorsIn,
110- int t) {
110+ sigtime_t t) {
111111 int map_sot_2_urdf[4 ] = {2 , 0 , 3 , 1 };
112112 sotDEBUGIN (15 );
113113 map<string, dgsot::SensorValues>::iterator it;
@@ -133,7 +133,7 @@ void SoTTestDevice::setSensorsForce(map<string, dgsot::SensorValues> &SensorsIn,
133133}
134134
135135void SoTTestDevice::setSensorsIMU (map<string, dgsot::SensorValues> &SensorsIn,
136- int t) {
136+ sigtime_t t) {
137137 map<string, dgsot::SensorValues>::iterator it;
138138 // TODO: Confirm if this can be made quaternion
139139 it = SensorsIn.find (" attitude" );
@@ -164,7 +164,7 @@ void SoTTestDevice::setSensorsIMU(map<string, dgsot::SensorValues> &SensorsIn,
164164}
165165
166166void SoTTestDevice::setSensorsEncoders (
167- map<string, dgsot::SensorValues> &SensorsIn, int t) {
167+ map<string, dgsot::SensorValues> &SensorsIn, sigtime_t t) {
168168 map<string, dgsot::SensorValues>::iterator it;
169169
170170 it = SensorsIn.find (" motor-angles" );
@@ -195,7 +195,7 @@ void SoTTestDevice::setSensorsEncoders(
195195}
196196
197197void SoTTestDevice::setSensorsVelocities (
198- map<string, dgsot::SensorValues> &SensorsIn, int t) {
198+ map<string, dgsot::SensorValues> &SensorsIn, sigtime_t t) {
199199 map<string, dgsot::SensorValues>::iterator it;
200200
201201 it = SensorsIn.find (" velocities" );
@@ -212,7 +212,7 @@ void SoTTestDevice::setSensorsVelocities(
212212}
213213
214214void SoTTestDevice::setSensorsTorquesCurrents (
215- map<string, dgsot::SensorValues> &SensorsIn, int t) {
215+ map<string, dgsot::SensorValues> &SensorsIn, sigtime_t t) {
216216 map<string, dgsot::SensorValues>::iterator it;
217217 it = SensorsIn.find (" torques" );
218218 if (it != SensorsIn.end ()) {
@@ -235,7 +235,7 @@ void SoTTestDevice::setSensorsTorquesCurrents(
235235}
236236
237237void SoTTestDevice::setSensorsGains (map<string, dgsot::SensorValues> &SensorsIn,
238- int t) {
238+ sigtime_t t) {
239239 map<string, dgsot::SensorValues>::iterator it;
240240 it = SensorsIn.find (" p_gains" );
241241 if (it != SensorsIn.end ()) {
@@ -259,7 +259,7 @@ void SoTTestDevice::setSensorsGains(map<string, dgsot::SensorValues> &SensorsIn,
259259void SoTTestDevice::setSensors (map<string, dgsot::SensorValues> &SensorsIn) {
260260 sotDEBUGIN (25 );
261261 map<string, dgsot::SensorValues>::iterator it;
262- int t = stateSOUT.getTime () + 1 ;
262+ sigtime_t t = stateSOUT.getTime () + 1 ;
263263
264264 setSensorsForce (SensorsIn, t);
265265 setSensorsIMU (SensorsIn, t);
@@ -312,7 +312,7 @@ void SoTTestDevice::getControl(map<string, dgsot::ControlValues> &controlOut,
312312 for (unsigned int i = 6 ; i < state_.size (); ++i) anglesOut[i - 6 ] = state_ (i);
313313 controlOut[" control" ].setValues (anglesOut);
314314 // Read zmp reference from input signal if plugged
315- int time = controlSIN.getTime ();
315+ sigtime_t time = controlSIN.getTime ();
316316 zmpSIN.recompute (time + 1 );
317317 // Express ZMP in free flyer reference frame
318318 dg::Vector zmpGlobal (4 );
0 commit comments