From 58190570f5f68e96c4e0b437b01a4e538851d4f5 Mon Sep 17 00:00:00 2001 From: Bertrand Songis Date: Fri, 22 Feb 2019 17:17:13 +0100 Subject: [PATCH] Telemetry now coming --- radio/src/pulses/pxx2.h | 2 +- radio/src/telemetry/telemetry.cpp | 9 +++++++++ 2 files changed, 10 insertions(+), 1 deletion(-) diff --git a/radio/src/pulses/pxx2.h b/radio/src/pulses/pxx2.h index 4adca374a..94d2ed885 100644 --- a/radio/src/pulses/pxx2.h +++ b/radio/src/pulses/pxx2.h @@ -30,7 +30,7 @@ #define PXX2_TYPE_ID_BIND 0x02 #define PXX2_TYPE_ID_CHANNELS 0x03 #define PXX2_TYPE_ID_RX_SETUP 0x05 - #define PXX2_TYPE_ID_SPORT 0xFE + #define PXX2_TYPE_ID_TELEMETRY 0xFE #define PXX2_TYPE_C_POWER_METER 0x02 #define PXX2_TYPE_ID_POWER_METER 0x01 diff --git a/radio/src/telemetry/telemetry.cpp b/radio/src/telemetry/telemetry.cpp index ac5883b6b..b1de783c9 100644 --- a/radio/src/telemetry/telemetry.cpp +++ b/radio/src/telemetry/telemetry.cpp @@ -121,6 +121,11 @@ void processBindFrame(uint8_t module, uint8_t * frame) } } +void processTelemetryFrame(uint8_t module, uint8_t * frame) +{ + sportProcessTelemetryPacketWithoutCrc(&frame[2]); +} + void processSpectrumFrame(uint8_t module, uint8_t * frame) { if (moduleSettings[module].mode != MODULE_MODE_SPECTRUM_ANALYSER) { @@ -153,6 +158,10 @@ void processRadioFrame(uint8_t module, uint8_t * frame) case PXX2_TYPE_ID_BIND: processBindFrame(module, frame); break; + + case PXX2_TYPE_ID_TELEMETRY: + processTelemetryFrame(module, frame); + break; } }