fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-23 12:07:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

Navigator: Force yaw pointing towards waypoint for all cases

Browse Source
This commit is contained in:
Lorenz Meier
2016-01-24 16:34:36 +01:00
parent 737fe1fc7f
commit 081da8bb7f
1 changed files with 5 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/navigator/mission.cpp
+5 -3
View File
@@ -194,9 +194,10 @@ Mission::on_active()
}
/* see if we need to update the current yaw heading */
if (_param_yawmode.get() != MISSION_YAWMODE_NONE
if ((_param_yawmode.get() != MISSION_YAWMODE_NONE
&& _param_yawmode.get() < MISSION_YAWMODE_MAX
&& _mission_type != MISSION_TYPE_NONE) {
&& _mission_type != MISSION_TYPE_NONE)
|| _navigator->get_vstatus()->is_vtol) {
heading_sp_update();
}
@@ -566,7 +567,8 @@ Mission::heading_sp_update()
}
/* always keep the front of the rotary wing pointing to the next waypoint */
if (_param_yawmode.get() == MISSION_YAWMODE_FRONT_TO_WAYPOINT) {
if (_param_yawmode.get() == MISSION_YAWMODE_FRONT_TO_WAYPOINT
|| _navigator->get_vstatus()->is_vtol) {
_mission_item.yaw = get_bearing_to_next_waypoint(
point_from_latlon[0],
point_from_latlon[1],