Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-09 09:28:31 -04:00
Code Issues Packages Projects Releases Wiki Activity

AC_WPNav: do not calculate NEU vector from invalid location

Browse Source
This commit is contained in:
Peter Barker 2019-09-10 14:41:14 +10:00 committed by Andrew Tridgell
parent 14f43f24a9
commit 89cfdb678f
1 changed files with 12 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/AC_WPNav/AC_WPNav.cpp
View File

@ -603,17 +603,20 @@ bool AC_WPNav::set_spline_destination(const Location& destination, bool stopped_
return false;
}
Vector3f next_dest_neu; // left uninitialised for valgrind
if (seg_end_type == SEGMENT_END_STRAIGHT ||
seg_end_type == SEGMENT_END_SPLINE) {
// make altitude frames consistent
if (!next_destination.change_alt_frame(destination.get_alt_frame())) {
return false;
}
// convert next destination to vector
Vector3f next_dest_neu;
bool next_dest_terr_alt;
if (!get_vector_NEU(next_destination, next_dest_neu, next_dest_terr_alt)) {
return false;
}
}
// set target as vector from EKF origin
return set_spline_destination(dest_neu, dest_terr_alt, stopped_at_start, seg_end_type, next_dest_neu);