mirror of https://github.com/ArduPilot/ardupilot
Send FS state to gcs for AR
This commit is contained in:
parent
61e5b09f28
commit
c2fd7617e1
|
@ -27,6 +27,10 @@ static NOINLINE void send_heartbeat(mavlink_channel_t chan)
|
||||||
uint8_t base_mode = MAV_MODE_FLAG_CUSTOM_MODE_ENABLED;
|
uint8_t base_mode = MAV_MODE_FLAG_CUSTOM_MODE_ENABLED;
|
||||||
uint8_t system_status = MAV_STATE_ACTIVE;
|
uint8_t system_status = MAV_STATE_ACTIVE;
|
||||||
uint32_t custom_mode = control_mode;
|
uint32_t custom_mode = control_mode;
|
||||||
|
|
||||||
|
if (failsafe != FAILSAFE_NONE) {
|
||||||
|
system_status = MAV_STATE_CRITICAL;
|
||||||
|
}
|
||||||
|
|
||||||
// work out the base_mode. This value is not very useful
|
// work out the base_mode. This value is not very useful
|
||||||
// for APM, but we calculate it as best we can so a generic
|
// for APM, but we calculate it as best we can so a generic
|
||||||
|
|
Loading…
Reference in New Issue