diff --git a/src/dynamic_graph/sot/dynamics/humanoid_robot.py b/src/dynamic_graph/sot/dynamics/humanoid_robot.py index 8fba878062510e610758cbc88ae87ce500e8ce2a..215339f850e3ede45b6764844ba7d011f7d94622 100755 --- a/src/dynamic_graph/sot/dynamics/humanoid_robot.py +++ b/src/dynamic_graph/sot/dynamics/humanoid_robot.py @@ -173,6 +173,8 @@ class AbstractHumanoidRobot (object): # --- center of mass ------------ self.dynamic.com.recompute(0) + self.dynamic.Jcom.recompute(0) + self.featureCom = FeatureGeneric(self.name + '.feature.com') plug(self.dynamic.com, self.featureCom.errorIN) plug(self.dynamic.Jcom, @@ -190,6 +192,7 @@ class AbstractHumanoidRobot (object): self.tasks = dict() for op in self.OperationalPoints: self.dynamic.signal(op).recompute(0) + self.dynamic.signal('J'+op).recompute(0) self.features[op] = \ FeaturePosition(self.name + '.feature.' + op, self.dynamic.signal(op),