diff --git a/libraries/SRV_Channel/SRV_Channel.h b/libraries/SRV_Channel/SRV_Channel.h index 304d55748d..9292248b1d 100644 --- a/libraries/SRV_Channel/SRV_Channel.h +++ b/libraries/SRV_Channel/SRV_Channel.h @@ -405,6 +405,14 @@ public: static bool upgrade_parameters(const uint8_t old_keys[14], uint16_t aux_channel_mask, RCMapper *rcmap); static void upgrade_motors_servo(uint8_t ap_motors_key, uint8_t ap_motors_idx, uint8_t new_channel); + // given a zero-based motor channel, return the k_motor function for that channel + static SRV_Channel::Aux_servo_function_t get_motor_function(uint8_t channel) { + if (channel < 8) { + return SRV_Channel::Aux_servo_function_t(SRV_Channel::k_motor1+channel); + } + return SRV_Channel::Aux_servo_function_t((SRV_Channel::k_motor9+(channel-8))); + } + private: struct { bool k_throttle_reversible:1;