diff --git a/main.py b/main.py index 73289ce..9b20b7b 100755 --- a/main.py +++ b/main.py @@ -286,8 +286,8 @@ if __name__ == "__main__": left_place = otc.tf_lookup('f2') left_place_angles = euler_from_quaternion([left_place.orientation.x , left_place.orientation.y , left_place.orientation.z, left_place.orientation.w]) - xangle = left_place_angles[0]+ radians(90) - xangle1 = left_place_angles[1] + xangle = left_place_angles[0] + xangle1 = left_place_angles[1]+ radians(180) xangle2 = left_place_angles[2] left_place_angles = (xangle, left_place_angles[1], left_place_angles[2]) target_quat = quaternion_from_euler(left_place_angles[0], left_place_angles[1], left_pick_angles[2])