From 0ca2a879af8ff5e5a1009dd9005aac7ca563c9b9 Mon Sep 17 00:00:00 2001 From: "maxim.karban@gmail.com" Date: Fri, 27 Apr 2012 17:23:57 +0000 Subject: [PATCH] evalVario(...); before altitude offset applied, fixes VSpd jumping numbers --- src/frsky.cpp | 8 +++++--- 1 file changed, 5 insertions(+), 3 deletions(-) diff --git a/src/frsky.cpp b/src/frsky.cpp index 8bc9e3869..39e61505d 100644 --- a/src/frsky.cpp +++ b/src/frsky.cpp @@ -266,15 +266,17 @@ void parseTelemHubByte(uint8_t byte) // First received barometer altitude => Altitude offset if (!frskyHubData.baroAltitudeOffset) frskyHubData.baroAltitudeOffset = -frskyHubData.baroAltitude_bp; + + if (g_model.varioSource == VARIO_SOURCE_BARO) { + evalVario(frskyHubData.baroAltitude_bp, frskyHubData.baroAltitude_ap); + } + frskyHubData.baroAltitude_bp += frskyHubData.baroAltitudeOffset; if (frskyHubData.baroAltitude_bp > frskyHubData.maxAltitude) frskyHubData.maxAltitude = frskyHubData.baroAltitude_bp; if (frskyHubData.baroAltitude_bp < frskyHubData.minAltitude) frskyHubData.minAltitude = frskyHubData.baroAltitude_bp; - if (g_model.varioSource == VARIO_SOURCE_BARO) { - evalVario(frskyHubData.baroAltitude_bp, frskyHubData.baroAltitude_ap); - } break; case offsetof(FrskyHubData, gpsAltitude_ap):