From 7b28910cc233d3fce55124cfa3b11375e18b560a Mon Sep 17 00:00:00 2001
From: Damjan Adamic <projectkk2glider@gmail.com>
Date: Mon, 20 Jul 2015 21:13:30 +0200
Subject: [PATCH] Re #2513: set value of duplicated telemetry sensors

---
 radio/src/telemetry/telemetry.cpp | 11 +++++++++--
 1 file changed, 9 insertions(+), 2 deletions(-)

diff --git a/radio/src/telemetry/telemetry.cpp b/radio/src/telemetry/telemetry.cpp
index 2fe5066bd..93fd18719 100644
--- a/radio/src/telemetry/telemetry.cpp
+++ b/radio/src/telemetry/telemetry.cpp
@@ -482,13 +482,20 @@ int lastUsedTelemetryIndex()
 
 void setTelemetryValue(TelemetryProtocol protocol, uint16_t id, uint8_t instance, int32_t value, uint32_t unit, uint32_t prec)
 {
+  bool available = false;
+
   for (int index=0; index<MAX_SENSORS; index++) {
     TelemetrySensor & telemetrySensor = g_model.telemetrySensors[index];
     if (telemetrySensor.type == TELEM_TYPE_CUSTOM && telemetrySensor.id == id && telemetrySensor.instance == instance) {
-     telemetryItems[index].setValue(telemetrySensor, value, unit, prec);
-     return;
+      telemetryItems[index].setValue(telemetrySensor, value, unit, prec);
+      available = true;
+      // we continue search here, because more than one sensor can have the same id and instance
     }
   }
+
+  if (available) {
+    return;
+  }
   
   int index = availableTelemetryIndex();
   if (index >= 0) {