This commit is contained in:
Max Hunt 2020-02-12 23:50:40 +00:00
parent 40e2a71c21
commit 0f1fdece00

View File

@ -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]
xangle1 = left_place_angles[1]+ radians(180)
xangle = left_place_angles[0]+ radians(180)
xangle1 = left_place_angles[1]
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])