diff --git a/libraries/SRV_Channel/SRV_Channel.h b/libraries/SRV_Channel/SRV_Channel.h index 32cc8c87fd..68eafd3281 100644 --- a/libraries/SRV_Channel/SRV_Channel.h +++ b/libraries/SRV_Channel/SRV_Channel.h @@ -21,6 +21,7 @@ #include #include #include +#include #ifndef NUM_SERVO_CHANNELS #if defined(HAL_BUILD_AP_PERIPH) && defined(HAL_PWM_COUNT) @@ -562,6 +563,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; diff --git a/libraries/SRV_Channel/SRV_Channels.cpp b/libraries/SRV_Channel/SRV_Channels.cpp index a9410acd42..3bcd7403a7 100644 --- a/libraries/SRV_Channel/SRV_Channels.cpp +++ b/libraries/SRV_Channel/SRV_Channels.cpp @@ -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();