From 1fac89374dd477a690c0fb12a49408dc6879dae5 Mon Sep 17 00:00:00 2001
From: Olivier Stasse <ostasse@laas.fr>
Date: Wed, 13 Jul 2016 16:06:49 +0200
Subject: [PATCH] Fix size of the angle after initializeRosNode.

---
 src/sot_loader.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/src/sot_loader.cpp b/src/sot_loader.cpp
index c983ab5..a8b5562 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_);
-- 
GitLab