diff --git a/libraries/AP_OpenDroneID/AP_OpenDroneID_DroneCAN.cpp b/libraries/AP_OpenDroneID/AP_OpenDroneID_DroneCAN.cpp index 57f9335b32..003234d2f3 100644 --- a/libraries/AP_OpenDroneID/AP_OpenDroneID_DroneCAN.cpp +++ b/libraries/AP_OpenDroneID/AP_OpenDroneID_DroneCAN.cpp @@ -28,6 +28,8 @@ #include #include +#include + #if HAL_MAX_CAN_PROTOCOL_DRIVERS static uavcan::Publisher* dc_location[HAL_MAX_CAN_PROTOCOL_DRIVERS]; static uavcan::Publisher* dc_basic_id[HAL_MAX_CAN_PROTOCOL_DRIVERS]; @@ -236,6 +238,9 @@ static void handle_arm_status(AP_UAVCAN* ap_uavcan, uint8_t node_id, const ArmSt strncpy_noterm(status.error, msg.error.c_str(), sizeof(status.error)); AP::opendroneid().set_arm_status(status); + + // Push DroneCAN Arm Message to GCS + gcs().send_to_active_channels(MAVLINK_MSG_ID_OPEN_DRONE_ID_ARM_STATUS,(const char*)&status); } // copy arm status for DroneCAN