dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

commander: safety button disarm require land detector 

- landed, maybe_landed, or ground_contact required before the safety
button is able to disarm
 - this reduces the risk of a faulty safety button triggering in regular
flight
This commit is contained in:
Daniel Agar 2020-01-20 13:48:02 -05:00 committed by Lorenz Meier
parent 4f868fc565
commit cf195b0755
1 changed files with 17 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

22
src/modules/commander/Commander.cpp
View File

@ -1429,13 +1429,25 @@ Commander::run()
const bool previous_safety_off = _safety.safety_off; const bool previous_safety_off = _safety.safety_off;
if (_safety_sub.copy(&_safety)) { if (_safety_sub.copy(&_safety)) {
// disarm if safety is now on and still armed
if (armed.armed && _safety.safety_switch_available && !_safety.safety_off) {
/* disarm if safety is now on and still armed */ bool safety_disarm_allowed = (status.hil_state == vehicle_status_s::HIL_STATE_OFF);
if (armed.armed && (status.hil_state == vehicle_status_s::HIL_STATE_OFF)
&& _safety.safety_switch_available && !_safety.safety_off) {
if (TRANSITION_CHANGED == arm_disarm(false, true, &mavlink_log_pub, "Safety button")) { // if land detector is available then prevent disarming via safety button if not landed
_status_changed = true; if (hrt_elapsed_time(&_land_detector.timestamp) < 1_s) {
bool maybe_landing = (_land_detector.landed || _land_detector.maybe_landed);
if (!maybe_landing) {
safety_disarm_allowed = false;
}
}
if (safety_disarm_allowed) {
if (TRANSITION_CHANGED == arm_disarm(false, true, &mavlink_log_pub, "Safety button")) {
_status_changed = true;
}
} }
} }