aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

GCS_MAVLink: call send_esc_telemetry for AP_ToshibaCAN ESCs

Browse Source
This commit is contained in:
Randy Mackay 2019-02-11 14:49:40 +09:00
parent 72d4727bcf
commit f8e49e5438
1 changed files with 9 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
libraries/GCS_MAVLink/GCS_Common.cpp
View File

@ -47,6 +47,7 @@
#if APM_BUILD_TYPE(APM_BUILD_ArduCopter) || APM_BUILD_TYPE(APM_BUILD_ArduPlane) || APM_BUILD_TYPE(APM_BUILD_ArduSub) #if APM_BUILD_TYPE(APM_BUILD_ArduCopter) || APM_BUILD_TYPE(APM_BUILD_ArduPlane) || APM_BUILD_TYPE(APM_BUILD_ArduSub)
#include <AP_KDECAN/AP_KDECAN.h> #include <AP_KDECAN/AP_KDECAN.h>
#endif #endif
#include <AP_ToshibaCAN/AP_ToshibaCAN.h>
#endif #endif
extern const AP_HAL::HAL& hal; extern const AP_HAL::HAL& hal;
@ -4125,8 +4126,15 @@ bool GCS_MAVLINK::try_send_message(const enum ap_message id)
if (ap_kdecan != nullptr) { if (ap_kdecan != nullptr) {
ap_kdecan->send_mavlink(uint8_t(chan)); ap_kdecan->send_mavlink(uint8_t(chan));
} }
break;
#endif #endif
break;
}
case AP_BoardConfig_CAN::Protocol_Type_ToshibaCAN: {
AP_ToshibaCAN *ap_tcan = AP_ToshibaCAN::get_tcan(i);
if (ap_tcan != nullptr) {
ap_tcan->send_esc_telemetry_mavlink(uint8_t(chan));
}
break;
} }
case AP_BoardConfig_CAN::Protocol_Type_UAVCAN: case AP_BoardConfig_CAN::Protocol_Type_UAVCAN:
case AP_BoardConfig_CAN::Protocol_Type_None: case AP_BoardConfig_CAN::Protocol_Type_None: