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-11 00:22:01 +00:00
parent c41511ac68
commit 95b72465a6
1 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
main.py
View File

@ -261,9 +261,9 @@ if __name__ == "__main__":
zqtr = quaternion_from_euler(xpos['roll'], xpos['pitch'], xpos['yaw']) zqtr = quaternion_from_euler(xpos['roll'], xpos['pitch'], xpos['yaw'])
left_place_pos = Pose() left_place_pos = Pose()
left_place_pos.position.x = left_place_pre.position.x + xpos['x'] left_place_pos.position.x = left_place_pre.position.x + xpos['z']
left_place_pos.position.y = left_place_pre.position.y + xpos['y'] left_place_pos.position.y = left_place_pre.position.y + xpos['x']
left_place_pos.position.z = left_place_pre.position.z + xpos['z'] left_place_pos.position.z = left_place_pre.position.z + xpos['y']
left_place_pos.orientation.x = left_place_pre.orientation.x + zqtr[0] left_place_pos.orientation.x = left_place_pre.orientation.x + zqtr[0]
left_place_pos.orientation.y = left_place_pre.orientation.y + zqtr[1] left_place_pos.orientation.y = left_place_pre.orientation.y + zqtr[1]
left_place_pos.orientation.z = left_place_pre.orientation.z + zqtr[2] left_place_pos.orientation.z = left_place_pre.orientation.z + zqtr[2]