Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Outgoing ARM message over MAVLINK

This commit is contained in:
Steve Borenstein 2022-08-18 14:04:36 -06:00 committed by Andrew Tridgell
parent b399ed3044
commit 95370ce74f
1 changed files with 5 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/AP_OpenDroneID/AP_OpenDroneID_DroneCAN.cpp
View File

@ -28,6 +28,8 @@
#include <dronecan/remoteid/System.hpp> #include <dronecan/remoteid/System.hpp>
#include <dronecan/remoteid/ArmStatus.hpp> #include <dronecan/remoteid/ArmStatus.hpp>
#include <GCS_MAVLink/GCS_MAVLink.h>
#if HAL_MAX_CAN_PROTOCOL_DRIVERS #if HAL_MAX_CAN_PROTOCOL_DRIVERS
static uavcan::Publisher<dronecan::remoteid::Location>* dc_location[HAL_MAX_CAN_PROTOCOL_DRIVERS]; static uavcan::Publisher<dronecan::remoteid::Location>* dc_location[HAL_MAX_CAN_PROTOCOL_DRIVERS];
static uavcan::Publisher<dronecan::remoteid::BasicID>* dc_basic_id[HAL_MAX_CAN_PROTOCOL_DRIVERS]; static uavcan::Publisher<dronecan::remoteid::BasicID>* 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)); strncpy_noterm(status.error, msg.error.c_str(), sizeof(status.error));
AP::opendroneid().set_arm_status(status); 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 // copy arm status for DroneCAN