multi protocol

radio/src/telemetry/telemetry_sensors.cpp

@@ -23,17 +23,31 @@
 TelemetryItem telemetryItems[MAX_TELEMETRY_SENSORS];
 uint8_t allowNewSensors;
 
-bool isFaiForbidden(source_t idx) {
+bool isFaiForbidden(source_t idx)
+{
   TelemetrySensor * sensor = &g_model.telemetrySensors[(idx-MIXSRC_FIRST_TELEM)/3];
-  if (sensor->id == RSSI_ID) {
-    return false;
-  }
-  else if (sensor->id == BATT_ID) {
-    return false;
-  }
-  else{
-    return true;
+
+  switch (telemetryProtocol) {
+    
+    case PROTOCOL_FRSKY_SPORT:
+      if (sensor->id == RSSI_ID) {
+        return false;
+      }
+      else if (sensor->id == BATT_ID) {
+        return false;
+      }
+      break;
+
+    case PROTOCOL_FRSKY_D:
+      if (sensor->id == D_RSSI_ID) {
+        return false;
+      }
+      else if (sensor->id == D_A1_ID) {
+        return false;
+      }
+      break;
   }
+  return true;
 }
 
 // TODO in maths