From a5928b752e5c6c17f34ef786540f48a8cf8da139 Mon Sep 17 00:00:00 2001
From: Iampete1 <iampete@hotmail.co.uk>
Date: Sun, 2 Jan 2022 17:41:22 +0000
Subject: [PATCH] SRV_Channels: set channels above 16 to GPIO by defualt

---
 libraries/SRV_Channel/SRV_Channels.cpp | 6 ++++++
 1 file changed, 6 insertions(+)

diff --git a/libraries/SRV_Channel/SRV_Channels.cpp b/libraries/SRV_Channel/SRV_Channels.cpp
index 4a4ea4cfff..beedfbb74c 100644
--- a/libraries/SRV_Channel/SRV_Channels.cpp
+++ b/libraries/SRV_Channel/SRV_Channels.cpp
@@ -356,6 +356,12 @@ SRV_Channels::SRV_Channels(void)
     // setup ch_num on channels
     for (uint8_t i=0; i<NUM_SERVO_CHANNELS; i++) {
         channels[i].ch_num = i;
+#if NUM_SERVO_CHANNELS > 16
+        if (i >= 16) {
+            // default to GPIO, this disables the pin and stops logging
+            channels[i].function.set_default(SRV_Channel::k_GPIO);
+        }
+#endif
     }
 
 #if AP_FETTEC_ONEWIRE_ENABLED