fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

fixed land requirement for VTOL

Browse Source 
Signed-off-by: RomanBapst <bapstroman@gmail.com>
This commit is contained in:
RomanBapst 2023-01-12 11:49:39 +03:00 committed by Roman Bapst
parent 6e07af959f
commit 741fbb931d
1 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
src/modules/navigator/MissionFeasibility/FeasibilityChecker.cpp
View File

@ -84,6 +84,7 @@ void FeasibilityChecker::updateData()
if (_home_pos_sub.updated()) {
_home_pos_sub.update(&home);
if (home.valid_hpos) {
_home_lat_lon = matrix::Vector2d(home.lat, home.lon);
}
@ -487,13 +488,15 @@ bool FeasibilityChecker::checkFixedWingLanding(mission_item_s &mission_item, con
}
}
if (land_start_found && (!_landing_valid || (_do_land_start_index > _landing_approach_index))) {
if (land_start_found && (_do_land_start_index > _landing_approach_index)) {
mavlink_log_critical(_mavlink_log_pub, "Mission rejected: invalid land start.\t");
events::send(events::ID("navigator_mis_invalid_land"), {events::Log::Error, events::LogInternal::Info},
"Mission rejected: invalid land start");
return false;
}
_landing_valid = _landing_approach_index >= 0;
/* No landing waypoints or no waypoints */
return true;
}