From 4a5c6fe1e5c32543618eda8856f42b33c9cd76c2 Mon Sep 17 00:00:00 2001 From: Randy Mackay Date: Wed, 5 Sep 2018 17:47:35 +0900 Subject: [PATCH] Tracker: enable aux servos at init and at 1hz --- AntennaTracker/AntennaTracker.cpp | 3 +++ AntennaTracker/servos.cpp | 3 +++ 2 files changed, 6 insertions(+) diff --git a/AntennaTracker/AntennaTracker.cpp b/AntennaTracker/AntennaTracker.cpp index 140c5461ac..0c4d865f77 100644 --- a/AntennaTracker/AntennaTracker.cpp +++ b/AntennaTracker/AntennaTracker.cpp @@ -93,6 +93,9 @@ void Tracker::one_second_loop() // sync MAVLink system ID mavlink_system.sysid = g.sysid_this_mav; + // update assigned functions and enable auxiliary servos + SRV_Channels::enable_aux_servos(); + // updated armed/disarmed status LEDs update_armed_disarmed(); diff --git a/AntennaTracker/servos.cpp b/AntennaTracker/servos.cpp index cdc49951f2..709c7156ed 100644 --- a/AntennaTracker/servos.cpp +++ b/AntennaTracker/servos.cpp @@ -7,6 +7,9 @@ // init_servos - initialises the servos void Tracker::init_servos() { + // update assigned functions and enable auxiliary servos + SRV_Channels::enable_aux_servos(); + SRV_Channels::set_default_function(CH_YAW, SRV_Channel::k_tracker_yaw); SRV_Channels::set_default_function(CH_PITCH, SRV_Channel::k_tracker_pitch);