yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-21 09:22:18 +00:00
Code Issues Packages Projects Releases Wiki Activity

commander: immediately publish kill switch state change

Browse Source
This commit is contained in:
Beat Küng
2018-04-06 11:00:11 +02:00
committed by Lorenz Meier
parent d025eb0da0
commit f1f72c70e0
1 changed files with 4 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
src/modules/commander/commander.cpp
View File

@@ -2483,13 +2483,15 @@ Commander::run()
/* set lockdown flag */
if (!armed.manual_lockdown) {
mavlink_log_emergency(&mavlink_log_pub, "MANUAL KILL SWITCH ENGAGED");
status_changed = true;
armed.manual_lockdown = true;
}
armed.manual_lockdown = true;
} else if (sp_man.kill_switch == manual_control_setpoint_s::SWITCH_POS_OFF) {
if (armed.manual_lockdown) {
mavlink_log_emergency(&mavlink_log_pub, "MANUAL KILL SWITCH OFF");
status_changed = true;
armed.manual_lockdown = false;
}
armed.manual_lockdown = false;
}
/* no else case: do not change lockdown flag in unconfigured case */
} else {