[SPORT] Sensor switches + Telemetry switch

2016-03-10 21:16:45 +01:00
parent 0341b9ffce
commit 64cd872055
2 changed files with 14 additions and 4 deletions
@@ -615,14 +615,24 @@ bool getSwitch(swsrc_t swtch)
    result = REB_DOWN();
  }
 #endif
-#if defined(CPUARM) && defined(FLIGHT_MODES)
+#if defined(CPUARM)
+  else if (cs_idx >= SWSRC_FIRST_SENSOR) {
+    result = !telemetryItems[cs_idx-SWSRC_FIRST_SENSOR].isOld();
+  }
+  else if (cs_idx == SWSRC_TELEMETRY_STREAMING) {
+    result = TELEMETRY_STREAMING();
+  }
  else if (cs_idx >= SWSRC_FIRST_FLIGHT_MODE) {
+#if defined(FLIGHT_MODES)
    uint8_t idx = cs_idx - SWSRC_FIRST_FLIGHT_MODE;
    if (flags & GETSWITCH_MIDPOS_DELAY)
      result = (idx == flightModeTransitionLast);
    else
      result = (idx == mixerCurrentFlightMode);
-  }
+#else
+    result = false;
+#endif
+   }
 #endif
  else {
    cs_idx -= SWSRC_FIRST_LOGICAL_SWITCH;