max/robotics
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Update

Browse Source
This commit is contained in:
Max Hunt 2020-02-08 17:54:11 +00:00
parent 11568a025d
commit d7d20f4559
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
main.py
View File

@ -401,7 +401,7 @@ right_pnp.move_to_start(right_pnp.ik_request(right_pose))
pose1 = Pose() pose1 = Pose()
pose1.position = Point(x=bricks_start[0]['x'], y=bricks_start[0]['y'], z=bricks_start[0]['z']) pose1.position = Point(x=bricks_start[0]['x'], y=bricks_start[0]['y'], z=bricks_start[0]['z'])
hqo = quaternion_from_euler(bricks_start[0]['roll'], bricks_start[0]['pitch'], bricks_start[0]['yaw']) hqo = quaternion_from_euler(bricks_start[0]['roll'], bricks_start[0]['pitch'], bricks_start[0]['yaw'])
pose1.orientation.orientation = Quaternion(hqo[0], hqo[1], hqo[2], hqo[3]) pose1.orientation = Quaternion(hqo[0], hqo[1], hqo[2], hqo[3])
right_pnp.move_to_start(right_pnp.ik_request(pose1)) right_pnp.move_to_start(right_pnp.ik_request(pose1))