diff --git a/src/dynamic_graph/sot/dynamics/humanoid_robot.py b/src/dynamic_graph/sot/dynamics/humanoid_robot.py index ce5e23f423d05aa72a6856264ca685bbd750ea39..82ca319803f8862ce3ed58c78ad5fa41899a6996 100755 --- a/src/dynamic_graph/sot/dynamics/humanoid_robot.py +++ b/src/dynamic_graph/sot/dynamics/humanoid_robot.py @@ -296,18 +296,11 @@ class AbstractHumanoidRobot (object): # --- additional frames --- self.frames = dict() frameName = 'rightHand' - hp = self.dynamic.getHandParameter (True) - transformation = list (map (list, I4)) - for i in range (3): transformation [i][3] = hp [i][3] - transformation = tuple (map (tuple, transformation)) self.frames [frameName] = self.createFrame ( "{0}_{1}".format (self.name, frameName), - transformation, "right-wrist") + self.dynamic.getHandParameter (True), "right-wrist") + frameName = 'leftHand' - hp = self.dynamic.getHandParameter (False) - transformation = list (map (list, I4)) - for i in range (3): transformation [i][3] = hp [i][3] - transformation = tuple (map (tuple, transformation)) self.frames [frameName] = self.createFrame ( "{0}_{1}".format (self.name, frameName), self.dynamic.getHandParameter (False), "left-wrist")