diff --git a/src/sot_loader.cpp b/src/sot_loader.cpp index de97fe4f5aa5e9b04e20ca687c1a54fb4be398a3..52386d910866b78b431e9be1c56d4b5272b73789 100644 --- a/src/sot_loader.cpp +++ b/src/sot_loader.cpp @@ -144,6 +144,7 @@ void SotLoader::initializeRosNode(int argc, char *argv[]) //Temporary fix. TODO: where should nbOfJoints_ be initialized from? if (ros::param::has("/sot/state_vector_map")) { angleEncoder_.resize(nbOfJoints_); + angleControl_.resize(nbOfJoints_); } startControlLoop();