Skip to content
Snippets Groups Projects
Commit 66bd37ab authored by Rohan Budhiraja's avatar Rohan Budhiraja
Browse files

[wip/sot-romeo-v3][patch] bugs in robot.py

parent 6b6850fe
No related branches found
No related tags found
No related merge requests found
......@@ -5,3 +5,4 @@ SHA1 (patch-aa) = 0319ccbe6c1622c7708972f6fa4fde3e9361002c
SHA1 (patch-ab) = f9980b73a906658126092a370fe79eb41f08dbb4
SHA1 (patch-ac) = 655321720aa1e96b8d24f515ecd4b60233061802
SHA1 (patch-ad) = 839d787b1ffb62cdba5a6620dda07c3cedd0e9fb
SHA1 (patch-ae) = bc58ebeb3b3ad06f0747ce7760e290481004ec35
diff --git src/dynamic_graph/sot/romeo/robot.py src/dynamic_graph/sot/romeo/robot.py
index 9fce636..d543666 100644
--- src/dynamic_graph/sot/romeo/robot.py
+++ src/dynamic_graph/sot/romeo/robot.py
@@ -168,8 +168,6 @@ class Robot (AbstractHumanoidRobot):
#0.0,
)
- jointMap = { }
- jointMap['BODY'] = 'body'
def __init__(self, name,
device = None,
@@ -202,15 +200,12 @@ class Robot (AbstractHumanoidRobot):
# correct the name of the body link
self.dynamic = RosRobotModel("{0}_dynamic".format(name))
- for i in self.jointMap:
- self.dynamic.addJointMapping(i, self.jointMap[i])
self.pinocchioModel = se3.buildModelFromUrdf(self.urdfDir + self.urdfName,
se3.JointModelFreeFlyer())
self.pinocchioData = self.pinocchioModel.createData()
self.dynamic.setModel(self.pinocchioModel)
self.dynamic.setData(self.pinocchioData)
- self.dynamic.loadUrdf(self.urdfDir + self.urdfName)
# complete feet position (TODO: move it into srdf file)
#ankle =self.dynamic.getAnklePositionInFootFrame()
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment