mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-17 10:51:37 +08:00
@@ -54,7 +54,7 @@ void FeasibilityChecker::reset()
|
|||||||
|
|
||||||
_mission_validity_failed = false;
|
_mission_validity_failed = false;
|
||||||
_takeoff_failed = false;
|
_takeoff_failed = false;
|
||||||
_land_pattern_validity_failed = false;
|
_fixed_wing_landing_failed = false;
|
||||||
_distance_first_waypoint_failed = false;
|
_distance_first_waypoint_failed = false;
|
||||||
_distance_between_waypoints_failed = false;
|
_distance_between_waypoints_failed = false;
|
||||||
_below_home_alt_failed = false;
|
_below_home_alt_failed = false;
|
||||||
@@ -201,16 +201,15 @@ void FeasibilityChecker::doCommonChecks(mission_item_s &mission_item, const int
|
|||||||
|
|
||||||
void FeasibilityChecker::doVtolChecks(mission_item_s &mission_item, const int current_index)
|
void FeasibilityChecker::doVtolChecks(mission_item_s &mission_item, const int current_index)
|
||||||
{
|
{
|
||||||
if (!_land_pattern_validity_failed) {
|
if (!_fixed_wing_landing_failed) {
|
||||||
_land_pattern_validity_failed = !checkLandPatternValidity(mission_item, current_index);
|
_fixed_wing_landing_failed = !checkFixedWingLanding(mission_item, current_index);
|
||||||
}
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void FeasibilityChecker::doFixedWingChecks(mission_item_s &mission_item, const int current_index)
|
void FeasibilityChecker::doFixedWingChecks(mission_item_s &mission_item, const int current_index)
|
||||||
{
|
{
|
||||||
if (!_land_pattern_validity_failed) {
|
if (!_fixed_wing_landing_failed) {
|
||||||
_land_pattern_validity_failed = !checkLandPatternValidity(mission_item, current_index);
|
_fixed_wing_landing_failed = !checkFixedWingLanding(mission_item, current_index);
|
||||||
}
|
}
|
||||||
|
|
||||||
if (!_fixed_wing_land_approach_failed) {
|
if (!_fixed_wing_land_approach_failed) {
|
||||||
@@ -488,7 +487,7 @@ bool FeasibilityChecker::checkFixedWindLandApproach(mission_item_s &mission_item
|
|||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
|
||||||
bool FeasibilityChecker::checkLandPatternValidity(mission_item_s &mission_item, const int current_index)
|
bool FeasibilityChecker::checkFixedWingLanding(mission_item_s &mission_item, const int current_index)
|
||||||
{
|
{
|
||||||
|
|
||||||
// if DO_LAND_START found then require valid landing AFTER
|
// if DO_LAND_START found then require valid landing AFTER
|
||||||
|
|||||||
@@ -66,7 +66,7 @@ public:
|
|||||||
return _takeoff_failed ||
|
return _takeoff_failed ||
|
||||||
_distance_first_waypoint_failed ||
|
_distance_first_waypoint_failed ||
|
||||||
_distance_between_waypoints_failed ||
|
_distance_between_waypoints_failed ||
|
||||||
_land_pattern_validity_failed ||
|
_fixed_wing_landing_failed ||
|
||||||
_fixed_wing_land_approach_failed ||
|
_fixed_wing_land_approach_failed ||
|
||||||
_below_home_alt_failed ||
|
_below_home_alt_failed ||
|
||||||
_mission_validity_failed ||
|
_mission_validity_failed ||
|
||||||
@@ -97,7 +97,7 @@ private:
|
|||||||
// internal flags to keep track of which checks failed
|
// internal flags to keep track of which checks failed
|
||||||
bool _mission_validity_failed{false};
|
bool _mission_validity_failed{false};
|
||||||
bool _takeoff_failed{false};
|
bool _takeoff_failed{false};
|
||||||
bool _land_pattern_validity_failed{false};
|
bool _fixed_wing_landing_failed{false};
|
||||||
bool _distance_first_waypoint_failed{false};
|
bool _distance_first_waypoint_failed{false};
|
||||||
bool _distance_between_waypoints_failed{false};
|
bool _distance_between_waypoints_failed{false};
|
||||||
bool _below_home_alt_failed{false};
|
bool _below_home_alt_failed{false};
|
||||||
@@ -128,7 +128,7 @@ private:
|
|||||||
// methods which are called for each mission item
|
// methods which are called for each mission item
|
||||||
bool checkMissionItemValidity(mission_item_s &mission_item, const int current_index);
|
bool checkMissionItemValidity(mission_item_s &mission_item, const int current_index);
|
||||||
bool checkTakeoff(mission_item_s &mission_item);
|
bool checkTakeoff(mission_item_s &mission_item);
|
||||||
bool checkLandPatternValidity(mission_item_s &mission_item, const int current_index);
|
bool checkFixedWingLanding(mission_item_s &mission_item, const int current_index);
|
||||||
bool checkDistanceToFirstWaypoint(mission_item_s &mission_item);
|
bool checkDistanceToFirstWaypoint(mission_item_s &mission_item);
|
||||||
bool checkDistancesBetweenWaypoints(const mission_item_s &mission_item);
|
bool checkDistancesBetweenWaypoints(const mission_item_s &mission_item);
|
||||||
bool checkIfBelowHomeAltitude(const mission_item_s &mission_item, const int current_index);
|
bool checkIfBelowHomeAltitude(const mission_item_s &mission_item, const int current_index);
|
||||||
|
|||||||
Reference in New Issue
Block a user