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

commander prearm_check limit simultaneous error messages

Browse Source
This commit is contained in:
Daniel Agar 2018-03-29 23:14:34 -04:00
parent 55596fad20
commit a2bc0bd947
1 changed files with 22 additions and 22 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

44
src/modules/commander/state_machine_helper.cpp
View File

@ -940,11 +940,11 @@ bool prearm_check(orb_advert_t *mavlink_log_pub, const vehicle_status_flags_s &s
// USB not connected
if (!status_flags.circuit_breaker_engaged_usb_check && status_flags.usb_connected) {
prearm_ok = false;
if (reportFailures) {
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: Flying with USB is not safe");
}
prearm_ok = false;
}
// battery and system power status
@ -952,50 +952,50 @@ bool prearm_check(orb_advert_t *mavlink_log_pub, const vehicle_status_flags_s &s
// Fail transition if power is not good
if (!status_flags.condition_power_input_valid) {
prearm_ok = false;
if (reportFailures) {
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: Connect power module");
}
prearm_ok = false;
}
// main battery level
if (battery.warning >= battery_status_s::BATTERY_WARNING_LOW) {
prearm_ok = false;
if (reportFailures) {
if (prearm_ok && reportFailures) {
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: LOW BATTERY");
}
prearm_ok = false;
}
}
// Arm Requirements: mission
if (arm_requirements & ARM_REQ_MISSION_BIT) {
if (prearm_ok && (arm_requirements & ARM_REQ_MISSION_BIT)) {
if (!status_flags.condition_auto_mission_available) {
prearm_ok = false;
if (reportFailures) {
if (prearm_ok && reportFailures) {
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: valid mission required");
}
prearm_ok = false;
}
if (!status_flags.condition_global_position_valid) {
prearm_ok = false;
if (reportFailures) {
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: global position required");
if (prearm_ok && reportFailures) {
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: mission requires global position");
}
prearm_ok = false;
}
}
// Arm Requirements: global position
if ((arm_requirements & ARM_REQ_GPS_BIT) && (!status_flags.condition_global_position_valid)) {
prearm_ok = false;
if (reportFailures) {
if (prearm_ok && reportFailures) {
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: global position required");
}
prearm_ok = false;
}
// Arm Requirements: authorization
@ -1007,13 +1007,13 @@ bool prearm_check(orb_advert_t *mavlink_log_pub, const vehicle_status_flags_s &s
}
// safety button (check last)
if (safety.safety_switch_available && !safety.safety_off) {
prearm_ok = false;
if (prearm_ok && safety.safety_switch_available && !safety.safety_off) {
// Fail transition if we need safety switch press
if (reportFailures) {
if (prearm_ok && reportFailures) {
mavlink_log_critical(mavlink_log_pub, "ARMING DENIED: Press safety switch first");
}
prearm_ok = false;
}
return prearm_ok;