[color] Dynamic MPM proto list

radio/src/telemetry/telemetry.cpp

@@ -22,6 +22,7 @@
 #include "multi.h"
 #include "pulses/afhds3.h"
 #include "mixer_scheduler.h"
+#include "io/multi_protolist.h"
 
 #if defined(LIBOPENUI)
   #include "libopenui.h"
@@ -137,6 +138,11 @@ void telemetryWakeup()
       LOG_TELEMETRY_WRITE_BYTE(data);
     } while (intmoduleFifo.pop(data));
   }
+#if defined(MULTI_PROTOLIST)
+  if (MultiRfProtocols::instance(INTERNAL_MODULE)->isScanning()) {
+    MultiRfProtocols::instance(INTERNAL_MODULE)->scanReply();
+  }
+#endif
 #endif
 
 #if defined(STM32)
@@ -147,6 +153,14 @@ void telemetryWakeup()
       LOG_TELEMETRY_WRITE_BYTE(data);
     } while (telemetryGetByte(&data));
   }
+
+#if defined(MULTI_PROTOLIST)
+  if (isModuleMultimodule(EXTERNAL_MODULE) &&
+      MultiRfProtocols::instance(EXTERNAL_MODULE)->isScanning()) {    
+    MultiRfProtocols::instance(EXTERNAL_MODULE)->scanReply();    
+  }
+#endif
+  
 #elif defined(PCBSKY9X)
   if (telemetryProtocol == PROTOCOL_TELEMETRY_FRSKY_D_SECONDARY) {
     while (telemetrySecondPortReceive(data)) {