From 96b3eb57310ffe3257f86d84eca947fdcdb5568c Mon Sep 17 00:00:00 2001 From: Max Hunt Date: Wed, 12 Feb 2020 23:25:36 +0000 Subject: [PATCH] Update --- main.py | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/main.py b/main.py index b6ba3c5..e8d3317 100755 --- a/main.py +++ b/main.py @@ -266,7 +266,7 @@ if __name__ == "__main__": left_pick = otc.tf_lookup('a1') left_pick_angles = euler_from_quaternion([left_pick.orientation.x , left_pick.orientation.y , left_pick.orientation.z, left_pick.orientation.w]) - xangle = left_pick_angles[2] + radians(90) + xangle = left_pick_angles[1] + radians(90) left_pick_angles = (xangle, left_pick_angles[1], left_pick_angles[2]) target_quat = quaternion_from_euler(left_pick_angles[0], left_pick_angles[1], left_pick_angles[2]) left_pick_proc = Pose() @@ -284,7 +284,7 @@ if __name__ == "__main__": left_place = otc.tf_lookup('f2') left_place_engles = euler_from_quaternion([left_place.orientation.x , left_place.orientation.y , left_place.orientation.z, left_place.orientation.w]) - xangle = left_place_engles[2] + radians(90) + xangle = left_place_engles[1] + radians(90) left_place_engles = (xangle, left_place_engles[1], left_place_engles[2]) target_quat = quaternion_from_euler(left_place_engles[0], left_place_engles[1], left_pick_angles[2]) left_place_pos = Pose()