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

Fix bug with yaw only reposition

Browse Source 
Fix formatting
This commit is contained in:
Don Gagne
2022-09-08 17:55:30 -04:00
committed by Daniel Agar
parent da01dd9eeb
commit 0987bb2e8e
1 changed files with 10 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/navigator/navigator_main.cpp
+10 -4
View File
@@ -303,12 +303,18 @@ void Navigator::run()
rep->current.alt = get_global_position()->alt; rep->current.alt = get_global_position()->alt;
} }
} else if (PX4_ISFINITE(cmd.param7)) { } else if (PX4_ISFINITE(cmd.param7) || PX4_ISFINITE(cmd.param4)) {
// Received only a request to change altitude, thus we keep the setpoint // Position is not changing, thus we keep the setpoint
rep->current.lat = PX4_ISFINITE(curr->current.lat) ? curr->current.lat : get_global_position()->lat; rep->current.lat = PX4_ISFINITE(curr->current.lat) ? curr->current.lat : get_global_position()->lat;
rep->current.lon = PX4_ISFINITE(curr->current.lon) ? curr->current.lon : get_global_position()->lon; rep->current.lon = PX4_ISFINITE(curr->current.lon) ? curr->current.lon : get_global_position()->lon;
rep->current.alt = cmd.param7;
only_alt_change_requested = true; if (PX4_ISFINITE(cmd.param7)) {
rep->current.alt = cmd.param7;
only_alt_change_requested = true;
} else {
rep->current.alt = get_global_position()->alt;
}
} else { } else {
// All three set to NaN - pause vehicle // All three set to NaN - pause vehicle