@@ -107,7 +107,7 @@ SoTTestDevice::SoTTestDevice(std::string RobotName)
107
107
SoTTestDevice::~SoTTestDevice () {}
108
108
109
109
void SoTTestDevice::setSensorsForce (map<string, dgsot::SensorValues> &SensorsIn,
110
- int t) {
110
+ sigtime_t t) {
111
111
int map_sot_2_urdf[4 ] = {2 , 0 , 3 , 1 };
112
112
sotDEBUGIN (15 );
113
113
map<string, dgsot::SensorValues>::iterator it;
@@ -133,7 +133,7 @@ void SoTTestDevice::setSensorsForce(map<string, dgsot::SensorValues> &SensorsIn,
133
133
}
134
134
135
135
void SoTTestDevice::setSensorsIMU (map<string, dgsot::SensorValues> &SensorsIn,
136
- int t) {
136
+ sigtime_t t) {
137
137
map<string, dgsot::SensorValues>::iterator it;
138
138
// TODO: Confirm if this can be made quaternion
139
139
it = SensorsIn.find (" attitude" );
@@ -164,7 +164,7 @@ void SoTTestDevice::setSensorsIMU(map<string, dgsot::SensorValues> &SensorsIn,
164
164
}
165
165
166
166
void SoTTestDevice::setSensorsEncoders (
167
- map<string, dgsot::SensorValues> &SensorsIn, int t) {
167
+ map<string, dgsot::SensorValues> &SensorsIn, sigtime_t t) {
168
168
map<string, dgsot::SensorValues>::iterator it;
169
169
170
170
it = SensorsIn.find (" motor-angles" );
@@ -195,7 +195,7 @@ void SoTTestDevice::setSensorsEncoders(
195
195
}
196
196
197
197
void SoTTestDevice::setSensorsVelocities (
198
- map<string, dgsot::SensorValues> &SensorsIn, int t) {
198
+ map<string, dgsot::SensorValues> &SensorsIn, sigtime_t t) {
199
199
map<string, dgsot::SensorValues>::iterator it;
200
200
201
201
it = SensorsIn.find (" velocities" );
@@ -212,7 +212,7 @@ void SoTTestDevice::setSensorsVelocities(
212
212
}
213
213
214
214
void SoTTestDevice::setSensorsTorquesCurrents (
215
- map<string, dgsot::SensorValues> &SensorsIn, int t) {
215
+ map<string, dgsot::SensorValues> &SensorsIn, sigtime_t t) {
216
216
map<string, dgsot::SensorValues>::iterator it;
217
217
it = SensorsIn.find (" torques" );
218
218
if (it != SensorsIn.end ()) {
@@ -235,7 +235,7 @@ void SoTTestDevice::setSensorsTorquesCurrents(
235
235
}
236
236
237
237
void SoTTestDevice::setSensorsGains (map<string, dgsot::SensorValues> &SensorsIn,
238
- int t) {
238
+ sigtime_t t) {
239
239
map<string, dgsot::SensorValues>::iterator it;
240
240
it = SensorsIn.find (" p_gains" );
241
241
if (it != SensorsIn.end ()) {
@@ -259,7 +259,7 @@ void SoTTestDevice::setSensorsGains(map<string, dgsot::SensorValues> &SensorsIn,
259
259
void SoTTestDevice::setSensors (map<string, dgsot::SensorValues> &SensorsIn) {
260
260
sotDEBUGIN (25 );
261
261
map<string, dgsot::SensorValues>::iterator it;
262
- int t = stateSOUT.getTime () + 1 ;
262
+ sigtime_t t = stateSOUT.getTime () + 1 ;
263
263
264
264
setSensorsForce (SensorsIn, t);
265
265
setSensorsIMU (SensorsIn, t);
@@ -312,7 +312,7 @@ void SoTTestDevice::getControl(map<string, dgsot::ControlValues> &controlOut,
312
312
for (unsigned int i = 6 ; i < state_.size (); ++i) anglesOut[i - 6 ] = state_ (i);
313
313
controlOut[" control" ].setValues (anglesOut);
314
314
// Read zmp reference from input signal if plugged
315
- int time = controlSIN.getTime ();
315
+ sigtime_t time = controlSIN.getTime ();
316
316
zmpSIN.recompute (time + 1 );
317
317
// Express ZMP in free flyer reference frame
318
318
dg::Vector zmpGlobal (4 );
0 commit comments