From 133a52473dc76a4890b16f7d5842ff25af284b46 Mon Sep 17 00:00:00 2001
From: bsongis <bsongis@8db61ce9-5e8f-94c8-fa6b-1d1c8bcca7d0>
Date: Fri, 29 Jun 2012 21:27:00 +0000
Subject: [PATCH] Problem with bars thresholds

---
 src/open9x.cpp | 5 +++--
 1 file changed, 3 insertions(+), 2 deletions(-)

diff --git a/src/open9x.cpp b/src/open9x.cpp
index 0be86f308..87bf989dc 100644
--- a/src/open9x.cpp
+++ b/src/open9x.cpp
@@ -566,9 +566,10 @@ bool __getSwitch(int8_t swtch)
         // Telemetry
         if (cs.v1 > CSW_CHOUT_BASE+NUM_CHNOUT) {
           y = convertTelemValue(cs.v1-(CSW_CHOUT_BASE+NUM_CHNOUT), 128+cs.v2);
-          if (cs.v1 >= CSW_CHOUT_BASE+NUM_CHNOUT+TELEM_ALT) {
+          uint8_t idx = cs.v1-CSW_CHOUT_BASE-NUM_CHNOUT-TELEM_ALT
+          if (idx < THLD_MAX) {
             // Fill the threshold array
-            barsThresholds[cs.v1-CSW_CHOUT_BASE-NUM_CHNOUT-TELEM_ALT] = 128 + cs.v2;
+            barsThresholds[idx] = 128 + cs.v2;
           }
         }
         else