Fix heading hold for ekf2 mission takeoff

This commit is contained in:
Sander Smeets
2016-12-27 13:05:26 +01:00
committed by Lorenz Meier
parent e491817610
commit 3649def02e
+2 -2
View File
@@ -560,8 +560,8 @@ Mission::set_mission_items()
_mission_item.nav_cmd = NAV_CMD_TAKEOFF; _mission_item.nav_cmd = NAV_CMD_TAKEOFF;
_mission_item.lat = _navigator->get_global_position()->lat; _mission_item.lat = _navigator->get_global_position()->lat;
_mission_item.lon = _navigator->get_global_position()->lon; _mission_item.lon = _navigator->get_global_position()->lon;
/* ignore yaw for takeoff items */ /* hold heading for takeoff items */
_mission_item.yaw = NAN; _mission_item.yaw = _navigator->get_global_position()->yaw;
_mission_item.altitude = takeoff_alt; _mission_item.altitude = takeoff_alt;
_mission_item.altitude_is_relative = false; _mission_item.altitude_is_relative = false;
_mission_item.autocontinue = true; _mission_item.autocontinue = true;