Skip to content

Commit a39d1a9

Browse files
Use int64_t as type for signal time.
1 parent eda7846 commit a39d1a9

File tree

2 files changed

+22
-21
lines changed

2 files changed

+22
-21
lines changed

tests/sot-test-device.cpp

Lines changed: 8 additions & 8 deletions
Original file line numberDiff line numberDiff line change
@@ -107,7 +107,7 @@ SoTTestDevice::SoTTestDevice(std::string RobotName)
107107
SoTTestDevice::~SoTTestDevice() {}
108108

109109
void 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

135135
void 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

166166
void 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

197197
void 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

214214
void 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

237237
void 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,
259259
void 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);

tests/sot-test-device.hh

Lines changed: 14 additions & 13 deletions
Original file line numberDiff line numberDiff line change
@@ -22,6 +22,7 @@
2222

2323
namespace dgsot = dynamicgraph::sot;
2424
namespace dg = dynamicgraph;
25+
typedef dg::sigtime_t sigtime_t;
2526

2627
class SoTTestDevice : public dgsot::Device {
2728
public:
@@ -54,34 +55,34 @@ class SoTTestDevice : public dgsot::Device {
5455
std::vector<double> baseff_;
5556

5657
/// Accelerations measured by accelerometers
57-
dynamicgraph::Signal<dg::Vector, int> accelerometerSOUT_;
58+
dynamicgraph::Signal<dg::Vector, sigtime_t> accelerometerSOUT_;
5859
/// Rotation velocity measured by gyrometers
59-
dynamicgraph::Signal<dg::Vector, int> gyrometerSOUT_;
60+
dynamicgraph::Signal<dg::Vector, sigtime_t> gyrometerSOUT_;
6061
/// motor currents
61-
dynamicgraph::Signal<dg::Vector, int> currentsSOUT_;
62+
dynamicgraph::Signal<dg::Vector, sigtime_t> currentsSOUT_;
6263
/// joint angles
63-
dynamicgraph::Signal<dg::Vector, int> joint_anglesSOUT_;
64+
dynamicgraph::Signal<dg::Vector, sigtime_t> joint_anglesSOUT_;
6465
/// motor angles
65-
dynamicgraph::Signal<dg::Vector, int> motor_anglesSOUT_;
66+
dynamicgraph::Signal<dg::Vector, sigtime_t> motor_anglesSOUT_;
6667

6768
/// proportional and derivative position-control gains
68-
dynamicgraph::Signal<dg::Vector, int> p_gainsSOUT_;
69+
dynamicgraph::Signal<dg::Vector, sigtime_t> p_gainsSOUT_;
6970

70-
dynamicgraph::Signal<dg::Vector, int> d_gainsSOUT_;
71+
dynamicgraph::Signal<dg::Vector, sigtime_t> d_gainsSOUT_;
7172

7273
/// Protected methods for internal variables filling
7374
void setSensorsForce(std::map<std::string, dgsot::SensorValues> &SensorsIn,
74-
int t);
75+
sigtime_t t);
7576
void setSensorsIMU(std::map<std::string, dgsot::SensorValues> &SensorsIn,
76-
int t);
77+
sigtime_t t);
7778
void setSensorsEncoders(std::map<std::string, dgsot::SensorValues> &SensorsIn,
78-
int t);
79+
sigtime_t t);
7980
void setSensorsVelocities(
80-
std::map<std::string, dgsot::SensorValues> &SensorsIn, int t);
81+
std::map<std::string, dgsot::SensorValues> &SensorsIn, sigtime_t t);
8182
void setSensorsTorquesCurrents(
82-
std::map<std::string, dgsot::SensorValues> &SensorsIn, int t);
83+
std::map<std::string, dgsot::SensorValues> &SensorsIn, sigtime_t t);
8384
void setSensorsGains(std::map<std::string, dgsot::SensorValues> &SensorsIn,
84-
int t);
85+
sigtime_t t);
8586

8687
/// Intermediate variables to avoid allocation during control
8788
dg::Vector dgforces_;

0 commit comments

Comments
 (0)