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

failureDetectorCheck: revise messageing

Browse Source
This commit is contained in:
Matthias Grob 2020-08-18 19:41:46 +02:00
parent 981e05c633
commit ab17b6bad4
1 changed files with 16 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

19
src/modules/commander/Arming/PreFlightCheck/checks/failureDetectorCheck.cpp
View File

@ -45,17 +45,30 @@ bool PreFlightCheck::failureDetectorCheck(orb_advert_t *mavlink_log_pub, const v
if (status.failure_detector_status != vehicle_status_s::FAILURE_NONE) {
if (report_fail) {
// in case an error is forgotten to get handled here the user at least gets a less specific message
const char *message = "Unspecified";
if (status.failure_detector_status & vehicle_status_s::FAILURE_ROLL) {
mavlink_log_critical(mavlink_log_pub, "Preflight Fail: Roll failure detected");
message = "Roll";
}
if (status.failure_detector_status & vehicle_status_s::FAILURE_PITCH) {
mavlink_log_critical(mavlink_log_pub, "Preflight Fail: Pitch failure detected");
message = "Pitch";
}
if (status.failure_detector_status & vehicle_status_s::FAILURE_ALT) {
mavlink_log_critical(mavlink_log_pub, "Preflight Fail: Altitude failure detected");
message = "Altitude";
}
if (status.failure_detector_status & vehicle_status_s::FAILURE_EXT) {
message = "Parachute";
}
if (status.failure_detector_status & vehicle_status_s::FAILURE_ARM_ESC) {
message = "ESC";
}
mavlink_log_critical(mavlink_log_pub, "Preflight Fail: %s failure detected", message);
}
return false;