From 5869b81e9c1c8d834cf057c78f52ad317cb63386 Mon Sep 17 00:00:00 2001 From: 3djc Date: Fri, 11 Nov 2016 19:55:53 +0100 Subject: [PATCH] Rb10 support (#4015) * Rb10 support * Even more thorough check * A simpler test for the more complex scenario :) (thx Bsongis :)) --- radio/src/telemetry/frsky_sport.cpp | 13 ++++++++++++- 1 file changed, 12 insertions(+), 1 deletion(-) diff --git a/radio/src/telemetry/frsky_sport.cpp b/radio/src/telemetry/frsky_sport.cpp index 6dacb1a76..d2de4205a 100644 --- a/radio/src/telemetry/frsky_sport.cpp +++ b/radio/src/telemetry/frsky_sport.cpp @@ -186,7 +186,18 @@ void sportProcessTelemetryPacket(uint8_t * packet) sportProcessTelemetryPacket(id, 1, instance, data >> 16); } else if (id >= RBOX_STATE_FIRST_ID && id <= RBOX_STATE_LAST_ID) { - uint16_t newServosState = data & 0xffff; + bool static isRB10 = false; + uint16_t newServosState; + + if (servosState == 0 && (data & 0xff00) == 0xff00) { + isRB10 = true; + } + if (isRB10) { + newServosState = data & 0x00ff; // 8ch only RB10 + } + else { + newServosState = data & 0xffff; + } if (newServosState != 0 && servosState == 0) { audioEvent(AU_SERVO_KO); }