diff --git a/src/sot_loader.cpp b/src/sot_loader.cpp index c983ab5fdffa7f410017bc2ff1b558c2d0e3e58a..a8b55629a890a971a9b7cdf05777e414483e68ea 100644 --- a/src/sot_loader.cpp +++ b/src/sot_loader.cpp @@ -76,6 +76,7 @@ void SotLoader::startControlLoop() void SotLoader::initializeRosNode(int argc, char *argv[]) { SotLoaderBasic::initializeRosNode(argc, argv); + angleEncoder_.resize(nbOfJoints_); startControlLoop(); } @@ -125,7 +126,6 @@ SotLoader::readControl(map<string,dgs::ControlValues> &controlValues) void SotLoader::setup() { - angleEncoder_.resize(nbOfJoints_); fillSensors(sensorsIn_); sotController_->setupSetSensors(sensorsIn_);