From 95b72465a6f618073cd2f8be0aced78602e8d997 Mon Sep 17 00:00:00 2001 From: Max Hunt Date: Tue, 11 Feb 2020 00:22:01 +0000 Subject: [PATCH] Update --- main.py | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/main.py b/main.py index 1afd3bf..50e7075 100755 --- a/main.py +++ b/main.py @@ -261,9 +261,9 @@ if __name__ == "__main__": zqtr = quaternion_from_euler(xpos['roll'], xpos['pitch'], xpos['yaw']) left_place_pos = Pose() - left_place_pos.position.x = left_place_pre.position.x + xpos['x'] - left_place_pos.position.y = left_place_pre.position.y + xpos['y'] - left_place_pos.position.z = left_place_pre.position.z + xpos['z'] + left_place_pos.position.x = left_place_pre.position.x + xpos['z'] + left_place_pos.position.y = left_place_pre.position.y + xpos['x'] + 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.y = left_place_pre.orientation.y + zqtr[1] left_place_pos.orientation.z = left_place_pre.orientation.z + zqtr[2]