Test conversion from view matrix to yaw pitch roll.

This commit is contained in:
yunfeibai
2017-06-02 16:56:05 -07:00
parent f350a506a6
commit 3506603d60
5 changed files with 29 additions and 9 deletions

View File

@@ -52,10 +52,10 @@ def readLogFile(filename, verbose = True):
#clid = p.connect(p.SHARED_MEMORY)
p.connect(p.GUI)
p.loadURDF("plane.urdf",[0,0,-0.3])
p.loadURDF("kuka_iiwa/model.urdf",[0,0,0])
p.loadURDF("cube.urdf",[2,2,5])
p.loadURDF("cube.urdf",[-2,-2,5])
p.loadURDF("cube.urdf",[2,-2,5])
p.loadURDF("kuka_iiwa/model.urdf",[0,0,10])
p.loadURDF("cube.urdf",[2,2,50])
p.loadURDF("cube.urdf",[-2,-2,50])
p.loadURDF("cube.urdf",[2,-2,50])
log = readLogFile("LOG0001.txt")