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

failureDetectorCheck: remove string manipulation

Browse Source
This commit is contained in:
Matthias Grob
2020-09-08 11:42:30 +02:00
parent 5eba25d2b5
commit f70dda12a6
1 changed files with 5 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/commander/Arming/PreFlightCheck/checks/failureDetectorCheck.cpp
+5 -10
View File
@@ -45,30 +45,25 @@ bool PreFlightCheck::failureDetectorCheck(orb_advert_t *mavlink_log_pub, const v
if (status.failure_detector_status != vehicle_status_s::FAILURE_NONE) { if (status.failure_detector_status != vehicle_status_s::FAILURE_NONE) {
if (report_fail) { 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) { if (status.failure_detector_status & vehicle_status_s::FAILURE_ROLL) {
message = "Roll"; mavlink_log_critical(mavlink_log_pub, "Preflight Fail: Roll failure detected");
} }
if (status.failure_detector_status & vehicle_status_s::FAILURE_PITCH) { if (status.failure_detector_status & vehicle_status_s::FAILURE_PITCH) {
message = "Pitch"; mavlink_log_critical(mavlink_log_pub, "Preflight Fail: Pitch failure detected");
} }
if (status.failure_detector_status & vehicle_status_s::FAILURE_ALT) { if (status.failure_detector_status & vehicle_status_s::FAILURE_ALT) {
message = "Altitude"; mavlink_log_critical(mavlink_log_pub, "Preflight Fail: Altitude failure detected");
} }
if (status.failure_detector_status & vehicle_status_s::FAILURE_EXT) { if (status.failure_detector_status & vehicle_status_s::FAILURE_EXT) {
message = "Parachute"; mavlink_log_critical(mavlink_log_pub, "Preflight Fail: Parachute failure detected");
} }
if (status.failure_detector_status & vehicle_status_s::FAILURE_ARM_ESC) { if (status.failure_detector_status & vehicle_status_s::FAILURE_ARM_ESC) {
message = "ESC"; mavlink_log_critical(mavlink_log_pub, "Preflight Fail: ESC failure detected");
} }
mavlink_log_critical(mavlink_log_pub, "Preflight Fail: %s failure detected", message);
} }
return false; return false;