From 84c4b3c1b8568e89fdd0ba70fe667fef0b7cff24 Mon Sep 17 00:00:00 2001 From: Bertrand Songis Date: Wed, 21 Mar 2018 18:56:41 +0100 Subject: [PATCH] Missing x100 factor for ESC RPMs --- radio/src/telemetry/frsky_sport.cpp | 9 ++++++--- 1 file changed, 6 insertions(+), 3 deletions(-) diff --git a/radio/src/telemetry/frsky_sport.cpp b/radio/src/telemetry/frsky_sport.cpp index 40bd8b305..9c03dfca9 100644 --- a/radio/src/telemetry/frsky_sport.cpp +++ b/radio/src/telemetry/frsky_sport.cpp @@ -221,16 +221,19 @@ void sportProcessTelemetryPacket(const uint8_t * packet) sportProcessTelemetryPacket(id, 0, instance, servosState); sportProcessTelemetryPacket(id, 1, instance, rboxState); } - else if (id >= ESC_POWER_FIRST_ID && id <= ESC_RPM_CONS_LAST_ID) { - // 2 sensors (POWER and RPM_CONS) + else if (id >= ESC_POWER_FIRST_ID && id <= ESC_POWER_LAST_ID) { sportProcessTelemetryPacket(id, 0, instance, data & 0xffff); sportProcessTelemetryPacket(id, 1, instance, data >> 16); } + else if (id >= ESC_RPM_CONS_FIRST_ID && id <= ESC_RPM_CONS_LAST_ID) { + sportProcessTelemetryPacket(id, 0, instance, 100 * (data & 0xffff)); + sportProcessTelemetryPacket(id, 1, instance, data >> 16); + } else if (id >= ESC_TEMPERATURE_FIRST_ID && id <= ESC_TEMPERATURE_LAST_ID) { sportProcessTelemetryPacket(id, 0, instance, data & 0x00ff); } else if (id >= GASSUIT_TEMP_FIRST_ID && id <= GASSUIT_FUEL_LAST_ID) { - // 2 sensors + // 2 GASSUIT sensors sportProcessTelemetryPacket(id, 0, instance, data & 0xffff); sportProcessTelemetryPacket(id, 1, instance, data >> 16); }