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

SRV_Channel: add FETtec support

This commit is contained in:
Pierre Kancir 2021-02-05 19:16:48 +01:00 committed by Peter Barker
parent 28706f5e23
commit 2020fbaa26
2 changed files with 24 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
libraries/SRV_Channel/SRV_Channel.h
View File

@ -21,6 +21,7 @@
#include <AP_RobotisServo/AP_RobotisServo.h>
#include <AP_SBusOut/AP_SBusOut.h>
#include <AP_BLHeli/AP_BLHeli.h>
#include <AP_FETtecOneWire/AP_FETtecOneWire.h>
#ifndef NUM_SERVO_CHANNELS
#if defined(HAL_BUILD_AP_PERIPH) && defined(HAL_PWM_COUNT)
@ -568,6 +569,11 @@ private:
AP_BLHeli blheli;
static AP_BLHeli *blheli_ptr;
#endif
#if HAL_AP_FETTEC_ONEWIRE_ENABLED
AP_FETtecOneWire fetteconwire;
static AP_FETtecOneWire *fetteconwire_ptr;
#endif // HAL_AP_FETTEC_ONEWIRE_ENABLED
#endif // HAL_BUILD_AP_PERIPH
static uint16_t disabled_mask;

19
libraries/SRV_Channel/SRV_Channels.cpp
View File

@ -47,6 +47,9 @@ SRV_Channels *SRV_Channels::_singleton;
AP_Volz_Protocol *SRV_Channels::volz_ptr;
AP_SBusOut *SRV_Channels::sbus_ptr;
AP_RobotisServo *SRV_Channels::robotis_ptr;
#if HAL_AP_FETTEC_ONEWIRE_ENABLED
AP_FETtecOneWire *SRV_Channels::fetteconwire_ptr;
#endif
#endif // HAL_BUILD_AP_PERIPH
uint16_t SRV_Channels::override_counter[NUM_SERVO_CHANNELS];
@ -197,6 +200,13 @@ const AP_Param::GroupInfo SRV_Channels::var_info[] = {
// @Group: _ROB_
// @Path: ../AP_RobotisServo/AP_RobotisServo.cpp
AP_SUBGROUPINFO(robotis, "_ROB_", 22, SRV_Channels, AP_RobotisServo),
#if HAL_AP_FETTEC_ONEWIRE_ENABLED
// @Group: _FTW_
// @Path: ../AP_FETtecOneWire/AP_FETtecOneWire.cpp
AP_SUBGROUPINFO(fetteconwire, "_FTW_", 25, SRV_Channels, AP_FETtecOneWire),
#endif
#endif // HAL_BUILD_AP_PERIPH
// @Param: _DSHOT_RATE
@ -236,6 +246,9 @@ SRV_Channels::SRV_Channels(void)
volz_ptr = &volz;
sbus_ptr = &sbus;
robotis_ptr = &robotis;
#if HAL_AP_FETTEC_ONEWIRE_ENABLED
fetteconwire_ptr = &fetteconwire;
#endif
#if HAL_SUPPORT_RCOUT_SERIAL
blheli_ptr = &blheli;
#endif
@ -343,7 +356,11 @@ void SRV_Channels::push()
// give robotis library a chance to update
robotis_ptr->update();
#if HAL_AP_FETTEC_ONEWIRE_ENABLED
fetteconwire_ptr->update();
#endif
#if HAL_SUPPORT_RCOUT_SERIAL
// give blheli telemetry a chance to update
blheli_ptr->update_telemetry();