From 4929caa24176ca2348c07d7900a54ca214a7ecdf Mon Sep 17 00:00:00 2001
From: Andy Piper <github@andypiper.com>
Date: Sat, 15 May 2021 09:48:14 +0100
Subject: [PATCH] AP_BLHeli: if there are no digital outputs disable telemetry

---
 libraries/AP_BLHeli/AP_BLHeli.cpp | 6 +++++-
 1 file changed, 5 insertions(+), 1 deletion(-)

diff --git a/libraries/AP_BLHeli/AP_BLHeli.cpp b/libraries/AP_BLHeli/AP_BLHeli.cpp
index 6a9c9a1faac..a0ff9892d1a 100644
--- a/libraries/AP_BLHeli/AP_BLHeli.cpp
+++ b/libraries/AP_BLHeli/AP_BLHeli.cpp
@@ -1492,6 +1492,10 @@ void AP_BLHeli::log_bidir_telemetry(void)
         }
     }
 
+    if (!SRV_Channels::have_digital_outputs()) {
+        return;
+    }
+
     // ask the next ESC for telemetry
     uint8_t idx_pos = last_telem_esc;
     for (uint8_t idx = (idx_pos + 1) % num_motors;
@@ -1517,7 +1521,7 @@ void AP_BLHeli::update_telemetry(void)
         log_bidir_telemetry();
     }
 #endif
-    if (!telem_uart) {
+    if (!telem_uart || !SRV_Channels::have_digital_outputs()) {
         return;
     }
     uint32_t now = AP_HAL::micros();