import pybullet as p
#p.connect(p.UDP,"192.168.86.100")
p.connect(p.SHARED_MEMORY)
p.resetSimulation()

objects = [p.loadURDF("plane.urdf", 0.000000,0.000000,0.000000,0.000000,0.000000,0.000000,1.000000)]
objects = [p.loadURDF("samurai.urdf", 0.000000,0.000000,0.000000,0.000000,0.000000,0.000000,1.000000)]
objects = [p.loadURDF("pr2_gripper.urdf", 0.500000,0.300006,0.700000,-0.000000,-0.000000,-0.000031,1.000000)]
pr2_gripper = objects[0]
print ("pr2_gripper=")
print (pr2_gripper)

jointPositions=[ 0.550569, 0.000000, 0.549657, 0.000000 ]
for jointIndex in range (p.getNumJoints(pr2_gripper)):
	p.resetJointState(pr2_gripper,jointIndex,jointPositions[jointIndex])

pr2_cid = p.createConstraint(pr2_gripper,-1,-1,-1,p.JOINT_FIXED,[0,0,0],[0.2,0,0],[0.500000,0.300006,0.700000])
print ("pr2_cid")
print (pr2_cid)

objects = [p.loadURDF("kuka_iiwa/model_vr_limits.urdf", 1.400000,-0.200000,0.600000,0.000000,0.000000,0.000000,1.000000)]
kuka = objects[0]
jointPositions=[ -0.000000, -0.000000, 0.000000, 1.570793, 0.000000, -1.036725, 0.000001 ]
for jointIndex in range (p.getNumJoints(kuka)):
	p.resetJointState(kuka,jointIndex,jointPositions[jointIndex])
	p.setJointMotorControl2(kuka,jointIndex,p.POSITION_CONTROL,jointPositions[jointIndex],0)

objects = [p.loadURDF("lego/lego.urdf", 1.000000,-0.200000,0.700000,0.000000,0.000000,0.000000,1.000000)]
objects = [p.loadURDF("lego/lego.urdf", 1.000000,-0.200000,0.800000,0.000000,0.000000,0.000000,1.000000)]
objects = [p.loadURDF("lego/lego.urdf", 1.000000,-0.200000,0.900000,0.000000,0.000000,0.000000,1.000000)]
objects = p.loadSDF("gripper/wsg50_one_motor_gripper_new_free_base.sdf")
kuka_gripper = objects[0]
print ("kuka gripper=")
print(kuka_gripper)

p.resetBasePositionAndOrientation(kuka_gripper,[0.923103,-0.200000,1.250036],[-0.000000,0.964531,-0.000002,-0.263970])
jointPositions=[ 0.000000, -0.011130, -0.206421, 0.205143, -0.009999, 0.000000, -0.010055, 0.000000 ]
for jointIndex in range (p.getNumJoints(kuka_gripper)):
	p.resetJointState(kuka_gripper,jointIndex,jointPositions[jointIndex])
	p.setJointMotorControl2(kuka_gripper,jointIndex,p.POSITION_CONTROL,jointPositions[jointIndex],0)


kuka_cid = p.createConstraint(kuka,   6,  kuka_gripper,0,p.JOINT_FIXED, [0,0,0], [0,0,0.05],[0,0,0])

objects = [p.loadURDF("jenga/jenga.urdf", 1.300000,-0.700000,0.750000,0.000000,0.707107,0.000000,0.707107)]
objects = [p.loadURDF("jenga/jenga.urdf", 1.200000,-0.700000,0.750000,0.000000,0.707107,0.000000,0.707107)]
objects = [p.loadURDF("jenga/jenga.urdf", 1.100000,-0.700000,0.750000,0.000000,0.707107,0.000000,0.707107)]
objects = [p.loadURDF("jenga/jenga.urdf", 1.000000,-0.700000,0.750000,0.000000,0.707107,0.000000,0.707107)]
objects = [p.loadURDF("jenga/jenga.urdf", 0.900000,-0.700000,0.750000,0.000000,0.707107,0.000000,0.707107)]
objects = [p.loadURDF("jenga/jenga.urdf", 0.800000,-0.700000,0.750000,0.000000,0.707107,0.000000,0.707107)]
objects = [p.loadURDF("table/table.urdf", 1.000000,-0.200000,0.000000,0.000000,0.000000,0.707107,0.707107)]
objects = [p.loadURDF("teddy_vhacd.urdf", 1.050000,-0.500000,0.700000,0.000000,0.000000,0.707107,0.707107)]
objects = [p.loadURDF("cube_small.urdf", 0.950000,-0.100000,0.700000,0.000000,0.000000,0.707107,0.707107)]
objects = [p.loadURDF("sphere_small.urdf", 0.850000,-0.400000,0.700000,0.000000,0.000000,0.707107,0.707107)]
objects = [p.loadURDF("duck_vhacd.urdf", 0.850000,-0.400000,0.900000,0.000000,0.000000,0.707107,0.707107)]
objects = p.loadSDF("kiva_shelf/model.sdf")
ob = objects[0]
p.resetBasePositionAndOrientation(ob,[0.000000,1.000000,1.204500],[0.000000,0.000000,0.000000,1.000000])
objects = [p.loadURDF("teddy_vhacd.urdf", -0.100000,0.600000,0.850000,0.000000,0.000000,0.000000,1.000000)]
objects = [p.loadURDF("sphere_small.urdf", -0.100000,0.955006,1.169706,0.633232,-0.000000,-0.000000,0.773962)]
objects = [p.loadURDF("cube_small.urdf", 0.300000,0.600000,0.850000,0.000000,0.000000,0.000000,1.000000)]
objects = [p.loadURDF("table_square/table_square.urdf", -1.000000,0.000000,0.000000,0.000000,0.000000,0.000000,1.000000)]
ob = objects[0]
jointPositions=[ 0.000000 ]
for jointIndex in range (p.getNumJoints(ob)):
	p.resetJointState(ob,jointIndex,jointPositions[jointIndex])

objects = [p.loadURDF("husky/husky.urdf", 2.000000,-5.000000,1.000000,0.000000,0.000000,0.000000,1.000000)]
ob = objects[0]
jointPositions=[ 0.000000, 0.000000, 0.000000, 0.000000, 0.000000, 0.000000, 0.000000, 0.000000, 0.000000, 0.000000 ]
for jointIndex in range (p.getNumJoints(ob)):
	p.resetJointState(ob,jointIndex,jointPositions[jointIndex])

p.setGravity(0.000000,0.000000,0.000000)
p.setGravity(0,0,-10)

p.stepSimulation()

p.disconnect()

[((3, 0, 3, 26), 'pybullet.connect', 'p.connect', ({(3, 10, 3, 25): 'p.SHARED_MEMORY'}, {}), '(p.SHARED_MEMORY)', True, 'import pybullet as p\n'), ((4, 0, 4, 19), 'pybullet.resetSimulation', 'p.resetSimulation', ({}, {}), '()', True, 'import pybullet as p\n'), ((17, 10, 17, 111), 'pybullet.createConstraint', 'p.createConstraint', ({(17, 29, 17, 40): 'pr2_gripper', (17, 41, 17, 43): '-1', (17, 44, 17, 46): '-1', (17, 47, 17, 49): '-1', (17, 50, 17, 63): 'p.JOINT_FIXED', (17, 64, 17, 71): '[0, 0, 0]', (17, 72, 17, 81): '[0.2, 0, 0]', (17, 82, 17, 110): '[0.5, 0.300006, 0.7]'}, {}), '(pr2_gripper, -1, -1, -1, p.JOINT_FIXED, [0, 0, 0], [0.2,\n    0, 0], [0.5, 0.300006, 0.7])', True, 'import pybullet as p\n'), ((31, 10, 31, 72), 'pybullet.loadSDF', 'p.loadSDF', ({(31, 20, 31, 71): '"""gripper/wsg50_one_motor_gripper_new_free_base.sdf"""'}, {}), "('gripper/wsg50_one_motor_gripper_new_free_base.sdf')", True, 'import pybullet as p\n'), ((36, 0, 36, 118), 'pybullet.resetBasePositionAndOrientation', 'p.resetBasePositionAndOrientation', ({(36, 34, 36, 46): 'kuka_gripper', (36, 47, 36, 76): '[0.923103, -0.2, 1.250036]', (36, 77, 36, 117): '[-0.0, 0.964531, -2e-06, -0.26397]'}, {}), '(kuka_gripper, [0.923103, -0.2, 1.250036],\n    [-0.0, 0.964531, -2e-06, -0.26397])', True, 'import pybullet as p\n'), ((43, 11, 43, 100), 'pybullet.createConstraint', 'p.createConstraint', ({(43, 30, 43, 34): 'kuka', (43, 38, 43, 39): '6', (43, 42, 43, 54): 'kuka_gripper', (43, 55, 43, 56): '0', (43, 57, 43, 70): 'p.JOINT_FIXED', (43, 72, 43, 79): '[0, 0, 0]', (43, 81, 43, 91): '[0, 0, 0.05]', (43, 92, 43, 99): '[0, 0, 0]'}, {}), '(kuka, 6, kuka_gripper, 0, p.JOINT_FIXED, [0, 0, 0], [0, \n    0, 0.05], [0, 0, 0])', True, 'import pybullet as p\n'), ((56, 10, 56, 43), 'pybullet.loadSDF', 'p.loadSDF', ({(56, 20, 56, 42): '"""kiva_shelf/model.sdf"""'}, {}), "('kiva_shelf/model.sdf')", True, 'import pybullet as p\n'), ((58, 0, 58, 104), 'pybullet.resetBasePositionAndOrientation', 'p.resetBasePositionAndOrientation', ({(58, 34, 58, 36): 'ob', (58, 37, 58, 65): '[0.0, 1.0, 1.2045]', (58, 66, 58, 103): '[0.0, 0.0, 0.0, 1.0]'}, {}), '(ob, [0.0, 1.0, 1.2045], [0.0, 0.0, 0.0, 1.0])', True, 'import pybullet as p\n'), ((74, 0, 74, 40), 'pybullet.setGravity', 'p.setGravity', ({(74, 13, 74, 21): '(0.0)', (74, 22, 74, 30): '(0.0)', (74, 31, 74, 39): '(0.0)'}, {}), '(0.0, 0.0, 0.0)', True, 'import pybullet as p\n'), ((75, 0, 75, 21), 'pybullet.setGravity', 'p.setGravity', ({(75, 13, 75, 14): '(0)', (75, 15, 75, 16): '(0)', (75, 17, 75, 20): '(-10)'}, {}), '(0, 0, -10)', True, 'import pybullet as p\n'), ((77, 0, 77, 18), 'pybullet.stepSimulation', 'p.stepSimulation', ({}, {}), '()', True, 'import pybullet as p\n'), ((79, 0, 79, 14), 'pybullet.disconnect', 'p.disconnect', ({}, {}), '()', True, 'import pybullet as p\n'), ((6, 11, 6, 99), 'pybullet.loadURDF', 'p.loadURDF', ({(6, 22, 6, 34): '"""plane.urdf"""', (6, 36, 6, 44): '(0.0)', (6, 45, 6, 53): '(0.0)', (6, 54, 6, 62): '(0.0)', (6, 63, 6, 71): '(0.0)', (6, 72, 6, 80): '(0.0)', (6, 81, 6, 89): '(0.0)', (6, 90, 6, 98): '(1.0)'}, {}), "('plane.urdf', 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 1.0)", True, 'import pybullet as p\n'), ((7, 11, 7, 101), 'pybullet.loadURDF', 'p.loadURDF', ({(7, 22, 7, 36): '"""samurai.urdf"""', (7, 38, 7, 46): '(0.0)', (7, 47, 7, 55): '(0.0)', (7, 56, 7, 64): '(0.0)', (7, 65, 7, 73): '(0.0)', (7, 74, 7, 82): '(0.0)', (7, 83, 7, 91): '(0.0)', (7, 92, 7, 100): '(1.0)'}, {}), "('samurai.urdf', 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 1.0)", True, 'import pybullet as p\n'), ((8, 11, 8, 108), 'pybullet.loadURDF', 'p.loadURDF', ({(8, 22, 8, 40): '"""pr2_gripper.urdf"""', (8, 42, 8, 50): '(0.5)', (8, 51, 8, 59): '(0.300006)', (8, 60, 8, 68): '(0.7)', (8, 69, 8, 78): '(-0.0)', (8, 79, 8, 88): '(-0.0)', (8, 89, 8, 98): '(-3.1e-05)', (8, 99, 8, 107): '(1.0)'}, {}), "('pr2_gripper.urdf', 0.5, 0.300006, 0.7, -0.0, -0.0, -3.1e-05, 1.0)", True, 'import pybullet as p\n'), ((14, 25, 14, 52), 'pybullet.getNumJoints', 'p.getNumJoints', ({(14, 40, 14, 51): 'pr2_gripper'}, {}), '(pr2_gripper)', True, 'import pybullet as p\n'), ((15, 1, 15, 69), 'pybullet.resetJointState', 'p.resetJointState', ({(15, 19, 15, 30): 'pr2_gripper', (15, 31, 15, 41): 'jointIndex', (15, 42, 15, 68): 'jointPositions[jointIndex]'}, {}), '(pr2_gripper, jointIndex, jointPositions[jointIndex])', True, 'import pybullet as p\n'), ((21, 11, 21, 120), 'pybullet.loadURDF', 'p.loadURDF', ({(21, 22, 21, 54): '"""kuka_iiwa/model_vr_limits.urdf"""', (21, 56, 21, 64): '(1.4)', (21, 65, 21, 74): '(-0.2)', (21, 75, 21, 83): '(0.6)', (21, 84, 21, 92): '(0.0)', (21, 93, 21, 101): '(0.0)', (21, 102, 21, 110): '(0.0)', (21, 111, 21, 119): '(1.0)'}, {}), "('kuka_iiwa/model_vr_limits.urdf', 1.4, -0.2, 0.6, 0.0, 0.0, 0.0, 1.0\n    )", True, 'import pybullet as p\n'), ((24, 25, 24, 45), 'pybullet.getNumJoints', 'p.getNumJoints', ({(24, 40, 24, 44): 'kuka'}, {}), '(kuka)', True, 'import pybullet as p\n'), ((25, 1, 25, 62), 'pybullet.resetJointState', 'p.resetJointState', ({(25, 19, 25, 23): 'kuka', (25, 24, 25, 34): 'jointIndex', (25, 35, 25, 61): 'jointPositions[jointIndex]'}, {}), '(kuka, jointIndex, jointPositions[jointIndex])', True, 'import pybullet as p\n'), ((26, 1, 26, 89), 'pybullet.setJointMotorControl2', 'p.setJointMotorControl2', ({(26, 25, 26, 29): 'kuka', (26, 30, 26, 40): 'jointIndex', (26, 41, 26, 59): 'p.POSITION_CONTROL', (26, 60, 26, 86): 'jointPositions[jointIndex]', (26, 87, 26, 88): '(0)'}, {}), '(kuka, jointIndex, p.POSITION_CONTROL,\n    jointPositions[jointIndex], 0)', True, 'import pybullet as p\n'), ((28, 11, 28, 104), 'pybullet.loadURDF', 'p.loadURDF', ({(28, 22, 28, 38): '"""lego/lego.urdf"""', (28, 40, 28, 48): '(1.0)', (28, 49, 28, 58): '(-0.2)', (28, 59, 28, 67): '(0.7)', (28, 68, 28, 76): '(0.0)', (28, 77, 28, 85): '(0.0)', (28, 86, 28, 94): '(0.0)', (28, 95, 28, 103): '(1.0)'}, {}), "('lego/lego.urdf', 1.0, -0.2, 0.7, 0.0, 0.0, 0.0, 1.0)", True, 'import pybullet as p\n'), ((29, 11, 29, 104), 'pybullet.loadURDF', 'p.loadURDF', ({(29, 22, 29, 38): '"""lego/lego.urdf"""', (29, 40, 29, 48): '(1.0)', (29, 49, 29, 58): '(-0.2)', (29, 59, 29, 67): '(0.8)', (29, 68, 29, 76): '(0.0)', (29, 77, 29, 85): '(0.0)', (29, 86, 29, 94): '(0.0)', (29, 95, 29, 103): '(1.0)'}, {}), "('lego/lego.urdf', 1.0, -0.2, 0.8, 0.0, 0.0, 0.0, 1.0)", True, 'import pybullet as p\n'), ((30, 11, 30, 104), 'pybullet.loadURDF', 'p.loadURDF', ({(30, 22, 30, 38): '"""lego/lego.urdf"""', (30, 40, 30, 48): '(1.0)', (30, 49, 30, 58): '(-0.2)', (30, 59, 30, 67): '(0.9)', (30, 68, 30, 76): '(0.0)', (30, 77, 30, 85): '(0.0)', (30, 86, 30, 94): '(0.0)', (30, 95, 30, 103): '(1.0)'}, {}), "('lego/lego.urdf', 1.0, -0.2, 0.9, 0.0, 0.0, 0.0, 1.0)", True, 'import pybullet as p\n'), ((38, 25, 38, 53), 'pybullet.getNumJoints', 'p.getNumJoints', ({(38, 40, 38, 52): 'kuka_gripper'}, {}), '(kuka_gripper)', True, 'import pybullet as p\n'), ((39, 1, 39, 70), 'pybullet.resetJointState', 'p.resetJointState', ({(39, 19, 39, 31): 'kuka_gripper', (39, 32, 39, 42): 'jointIndex', (39, 43, 39, 69): 'jointPositions[jointIndex]'}, {}), '(kuka_gripper, jointIndex, jointPositions[jointIndex])', True, 'import pybullet as p\n'), ((40, 1, 40, 97), 'pybullet.setJointMotorControl2', 'p.setJointMotorControl2', ({(40, 25, 40, 37): 'kuka_gripper', (40, 38, 40, 48): 'jointIndex', (40, 49, 40, 67): 'p.POSITION_CONTROL', (40, 68, 40, 94): 'jointPositions[jointIndex]', (40, 95, 40, 96): '(0)'}, {}), '(kuka_gripper, jointIndex, p.POSITION_CONTROL,\n    jointPositions[jointIndex], 0)', True, 'import pybullet as p\n'), ((45, 11, 45, 106), 'pybullet.loadURDF', 'p.loadURDF', ({(45, 22, 45, 40): '"""jenga/jenga.urdf"""', (45, 42, 45, 50): '(1.3)', (45, 51, 45, 60): '(-0.7)', (45, 61, 45, 69): '(0.75)', (45, 70, 45, 78): '(0.0)', (45, 79, 45, 87): '(0.707107)', (45, 88, 45, 96): '(0.0)', (45, 97, 45, 105): '(0.707107)'}, {}), "('jenga/jenga.urdf', 1.3, -0.7, 0.75, 0.0, 0.707107, 0.0, 0.707107)", True, 'import pybullet as p\n'), ((46, 11, 46, 106), 'pybullet.loadURDF', 'p.loadURDF', ({(46, 22, 46, 40): '"""jenga/jenga.urdf"""', (46, 42, 46, 50): '(1.2)', (46, 51, 46, 60): '(-0.7)', (46, 61, 46, 69): '(0.75)', (46, 70, 46, 78): '(0.0)', (46, 79, 46, 87): '(0.707107)', (46, 88, 46, 96): '(0.0)', (46, 97, 46, 105): '(0.707107)'}, {}), "('jenga/jenga.urdf', 1.2, -0.7, 0.75, 0.0, 0.707107, 0.0, 0.707107)", True, 'import pybullet as p\n'), ((47, 11, 47, 106), 'pybullet.loadURDF', 'p.loadURDF', ({(47, 22, 47, 40): '"""jenga/jenga.urdf"""', (47, 42, 47, 50): '(1.1)', (47, 51, 47, 60): '(-0.7)', (47, 61, 47, 69): '(0.75)', (47, 70, 47, 78): '(0.0)', (47, 79, 47, 87): '(0.707107)', (47, 88, 47, 96): '(0.0)', (47, 97, 47, 105): '(0.707107)'}, {}), "('jenga/jenga.urdf', 1.1, -0.7, 0.75, 0.0, 0.707107, 0.0, 0.707107)", True, 'import pybullet as p\n'), ((48, 11, 48, 106), 'pybullet.loadURDF', 'p.loadURDF', ({(48, 22, 48, 40): '"""jenga/jenga.urdf"""', (48, 42, 48, 50): '(1.0)', (48, 51, 48, 60): '(-0.7)', (48, 61, 48, 69): '(0.75)', (48, 70, 48, 78): '(0.0)', (48, 79, 48, 87): '(0.707107)', (48, 88, 48, 96): '(0.0)', (48, 97, 48, 105): '(0.707107)'}, {}), "('jenga/jenga.urdf', 1.0, -0.7, 0.75, 0.0, 0.707107, 0.0, 0.707107)", True, 'import pybullet as p\n'), ((49, 11, 49, 106), 'pybullet.loadURDF', 'p.loadURDF', ({(49, 22, 49, 40): '"""jenga/jenga.urdf"""', (49, 42, 49, 50): '(0.9)', (49, 51, 49, 60): '(-0.7)', (49, 61, 49, 69): '(0.75)', (49, 70, 49, 78): '(0.0)', (49, 79, 49, 87): '(0.707107)', (49, 88, 49, 96): '(0.0)', (49, 97, 49, 105): '(0.707107)'}, {}), "('jenga/jenga.urdf', 0.9, -0.7, 0.75, 0.0, 0.707107, 0.0, 0.707107)", True, 'import pybullet as p\n'), ((50, 11, 50, 106), 'pybullet.loadURDF', 'p.loadURDF', ({(50, 22, 50, 40): '"""jenga/jenga.urdf"""', (50, 42, 50, 50): '(0.8)', (50, 51, 50, 60): '(-0.7)', (50, 61, 50, 69): '(0.75)', (50, 70, 50, 78): '(0.0)', (50, 79, 50, 87): '(0.707107)', (50, 88, 50, 96): '(0.0)', (50, 97, 50, 105): '(0.707107)'}, {}), "('jenga/jenga.urdf', 0.8, -0.7, 0.75, 0.0, 0.707107, 0.0, 0.707107)", True, 'import pybullet as p\n'), ((51, 11, 51, 106), 'pybullet.loadURDF', 'p.loadURDF', ({(51, 22, 51, 40): '"""table/table.urdf"""', (51, 42, 51, 50): '(1.0)', (51, 51, 51, 60): '(-0.2)', (51, 61, 51, 69): '(0.0)', (51, 70, 51, 78): '(0.0)', (51, 79, 51, 87): '(0.0)', (51, 88, 51, 96): '(0.707107)', (51, 97, 51, 105): '(0.707107)'}, {}), "('table/table.urdf', 1.0, -0.2, 0.0, 0.0, 0.0, 0.707107, 0.707107)", True, 'import pybullet as p\n'), ((52, 11, 52, 106), 'pybullet.loadURDF', 'p.loadURDF', ({(52, 22, 52, 40): '"""teddy_vhacd.urdf"""', (52, 42, 52, 50): '(1.05)', (52, 51, 52, 60): '(-0.5)', (52, 61, 52, 69): '(0.7)', (52, 70, 52, 78): '(0.0)', (52, 79, 52, 87): '(0.0)', (52, 88, 52, 96): '(0.707107)', (52, 97, 52, 105): '(0.707107)'}, {}), "('teddy_vhacd.urdf', 1.05, -0.5, 0.7, 0.0, 0.0, 0.707107, 0.707107)", True, 'import pybullet as p\n'), ((53, 11, 53, 105), 'pybullet.loadURDF', 'p.loadURDF', ({(53, 22, 53, 39): '"""cube_small.urdf"""', (53, 41, 53, 49): '(0.95)', (53, 50, 53, 59): '(-0.1)', (53, 60, 53, 68): '(0.7)', (53, 69, 53, 77): '(0.0)', (53, 78, 53, 86): '(0.0)', (53, 87, 53, 95): '(0.707107)', (53, 96, 53, 104): '(0.707107)'}, {}), "('cube_small.urdf', 0.95, -0.1, 0.7, 0.0, 0.0, 0.707107, 0.707107)", True, 'import pybullet as p\n'), ((54, 11, 54, 107), 'pybullet.loadURDF', 'p.loadURDF', ({(54, 22, 54, 41): '"""sphere_small.urdf"""', (54, 43, 54, 51): '(0.85)', (54, 52, 54, 61): '(-0.4)', (54, 62, 54, 70): '(0.7)', (54, 71, 54, 79): '(0.0)', (54, 80, 54, 88): '(0.0)', (54, 89, 54, 97): '(0.707107)', (54, 98, 54, 106): '(0.707107)'}, {}), "('sphere_small.urdf', 0.85, -0.4, 0.7, 0.0, 0.0, 0.707107, 0.707107)", True, 'import pybullet as p\n'), ((55, 11, 55, 105), 'pybullet.loadURDF', 'p.loadURDF', ({(55, 22, 55, 39): '"""duck_vhacd.urdf"""', (55, 41, 55, 49): '(0.85)', (55, 50, 55, 59): '(-0.4)', (55, 60, 55, 68): '(0.9)', (55, 69, 55, 77): '(0.0)', (55, 78, 55, 86): '(0.0)', (55, 87, 55, 95): '(0.707107)', (55, 96, 55, 104): '(0.707107)'}, {}), "('duck_vhacd.urdf', 0.85, -0.4, 0.9, 0.0, 0.0, 0.707107, 0.707107)", True, 'import pybullet as p\n'), ((59, 11, 59, 106), 'pybullet.loadURDF', 'p.loadURDF', ({(59, 22, 59, 40): '"""teddy_vhacd.urdf"""', (59, 42, 59, 51): '(-0.1)', (59, 52, 59, 60): '(0.6)', (59, 61, 59, 69): '(0.85)', (59, 70, 59, 78): '(0.0)', (59, 79, 59, 87): '(0.0)', (59, 88, 59, 96): '(0.0)', (59, 97, 59, 105): '(1.0)'}, {}), "('teddy_vhacd.urdf', -0.1, 0.6, 0.85, 0.0, 0.0, 0.0, 1.0)", True, 'import pybullet as p\n'), ((60, 11, 60, 109), 'pybullet.loadURDF', 'p.loadURDF', ({(60, 22, 60, 41): '"""sphere_small.urdf"""', (60, 43, 60, 52): '(-0.1)', (60, 53, 60, 61): '(0.955006)', (60, 62, 60, 70): '(1.169706)', (60, 71, 60, 79): '(0.633232)', (60, 80, 60, 89): '(-0.0)', (60, 90, 60, 99): '(-0.0)', (60, 100, 60, 108): '(0.773962)'}, {}), "('sphere_small.urdf', -0.1, 0.955006, 1.169706, 0.633232, -0.0, -\n    0.0, 0.773962)", True, 'import pybullet as p\n'), ((61, 11, 61, 104), 'pybullet.loadURDF', 'p.loadURDF', ({(61, 22, 61, 39): '"""cube_small.urdf"""', (61, 41, 61, 49): '(0.3)', (61, 50, 61, 58): '(0.6)', (61, 59, 61, 67): '(0.85)', (61, 68, 61, 76): '(0.0)', (61, 77, 61, 85): '(0.0)', (61, 86, 61, 94): '(0.0)', (61, 95, 61, 103): '(1.0)'}, {}), "('cube_small.urdf', 0.3, 0.6, 0.85, 0.0, 0.0, 0.0, 1.0)", True, 'import pybullet as p\n'), ((62, 11, 62, 120), 'pybullet.loadURDF', 'p.loadURDF', ({(62, 22, 62, 54): '"""table_square/table_square.urdf"""', (62, 56, 62, 65): '(-1.0)', (62, 66, 62, 74): '(0.0)', (62, 75, 62, 83): '(0.0)', (62, 84, 62, 92): '(0.0)', (62, 93, 62, 101): '(0.0)', (62, 102, 62, 110): '(0.0)', (62, 111, 62, 119): '(1.0)'}, {}), "('table_square/table_square.urdf', -1.0, 0.0, 0.0, 0.0, 0.0, 0.0, 1.0\n    )", True, 'import pybullet as p\n'), ((65, 25, 65, 43), 'pybullet.getNumJoints', 'p.getNumJoints', ({(65, 40, 65, 42): 'ob'}, {}), '(ob)', True, 'import pybullet as p\n'), ((66, 1, 66, 60), 'pybullet.resetJointState', 'p.resetJointState', ({(66, 19, 66, 21): 'ob', (66, 22, 66, 32): 'jointIndex', (66, 33, 66, 59): 'jointPositions[jointIndex]'}, {}), '(ob, jointIndex, jointPositions[jointIndex])', True, 'import pybullet as p\n'), ((68, 11, 68, 106), 'pybullet.loadURDF', 'p.loadURDF', ({(68, 22, 68, 40): '"""husky/husky.urdf"""', (68, 42, 68, 50): '(2.0)', (68, 51, 68, 60): '(-5.0)', (68, 61, 68, 69): '(1.0)', (68, 70, 68, 78): '(0.0)', (68, 79, 68, 87): '(0.0)', (68, 88, 68, 96): '(0.0)', (68, 97, 68, 105): '(1.0)'}, {}), "('husky/husky.urdf', 2.0, -5.0, 1.0, 0.0, 0.0, 0.0, 1.0)", True, 'import pybullet as p\n'), ((71, 25, 71, 43), 'pybullet.getNumJoints', 'p.getNumJoints', ({(71, 40, 71, 42): 'ob'}, {}), '(ob)', True, 'import pybullet as p\n'), ((72, 1, 72, 60), 'pybullet.resetJointState', 'p.resetJointState', ({(72, 19, 72, 21): 'ob', (72, 22, 72, 32): 'jointIndex', (72, 33, 72, 59): 'jointPositions[jointIndex]'}, {}), '(ob, jointIndex, jointPositions[jointIndex])', True, 'import pybullet as p\n')]