simple_offboard/target yaw fix

This commit is contained in:
Oleg Kalachev
2017-12-06 06:15:39 +03:00
parent 07d42dce35
commit 2711b65a25

View File

@@ -465,7 +465,7 @@ def start_loop():
p.header.frame_id = 'local_origin'
p.header.stamp = stamp
p.pose.position = current_msg.position
p.pose.orientation = orientation_from_euler(0, 0, current_msg.yaw)
p.pose.orientation = orientation_from_euler(0, 0, current_msg.yaw + math.pi / 2)
target_pub.publish(p)
except Exception as e: