mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-27 10:17:45 +08:00
commander: immediately publish kill switch state change
This commit is contained in:
@@ -2483,13 +2483,15 @@ Commander::run()
|
|||||||
/* set lockdown flag */
|
/* set lockdown flag */
|
||||||
if (!armed.manual_lockdown) {
|
if (!armed.manual_lockdown) {
|
||||||
mavlink_log_emergency(&mavlink_log_pub, "MANUAL KILL SWITCH ENGAGED");
|
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) {
|
} else if (sp_man.kill_switch == manual_control_setpoint_s::SWITCH_POS_OFF) {
|
||||||
if (armed.manual_lockdown) {
|
if (armed.manual_lockdown) {
|
||||||
mavlink_log_emergency(&mavlink_log_pub, "MANUAL KILL SWITCH OFF");
|
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 */
|
/* no else case: do not change lockdown flag in unconfigured case */
|
||||||
} else {
|
} else {
|
||||||
|
|||||||
Reference in New Issue
Block a user