diff --git a/src/dynamic_graph/sot/dynamics/humanoid_robot.py b/src/dynamic_graph/sot/dynamics/humanoid_robot.py index 3d2487ba63876c1ce0259e3e52738222c3bf9b62..c45a17906916dd7e46d5fde7a0968f3b69af4d61 100755 --- a/src/dynamic_graph/sot/dynamics/humanoid_robot.py +++ b/src/dynamic_graph/sot/dynamics/humanoid_robot.py @@ -221,11 +221,12 @@ class AbstractHumanoidRobot (object): self.features = dict() self.tasks = dict() for op in self.OperationalPoints: + self.dynamicRobot.signal(op).recompute(0) self.features[op] = \ FeaturePosition(self.name + '.feature.' + op, self.dynamicRobot.signal(op), self.dynamicRobot.signal('J' + op), - SE3()) + self.dynamicRobot.signal(op).value) self.tasks[op] = Task(self.name + '.task.' + op) self.tasks[op].add(self.name + '.feature.' + op) self.tasks[op].signal('controlGain').value = .2