From 571be5bf77515f8a68e4ef7e137d634df4b759cf Mon Sep 17 00:00:00 2001 From: bsongis Date: Tue, 8 May 2012 21:08:12 +0000 Subject: [PATCH] Vario fix --- src/frsky.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/src/frsky.cpp b/src/frsky.cpp index deb1b6ad0..e900c0109 100644 --- a/src/frsky.cpp +++ b/src/frsky.cpp @@ -168,7 +168,7 @@ int16_t applyChannelRatio(uint8_t channel, int16_t val) return ((int32_t)val+g_model.frsky.channels[channel].offset) * (g_model.frsky.channels[channel].ratio << g_model.frsky.channels[channel].multiplier) * 2 / 51; } -inline void evalVario(int16_t altitude_bp, uint16_t altitude_ap) +void evalVario(int16_t altitude_bp, uint16_t altitude_ap) { int32_t varioAltitude_cm = (int32_t)altitude_bp * 100 + (altitude_bp > 0 ? altitude_ap : -altitude_ap); uint8_t varioAltitudeQueuePointer = frskyHubData.varioAltitudeQueuePointer + 1; @@ -274,7 +274,7 @@ void parseTelemHubByte(uint8_t byte) if (!frskyHubData.baroAltitudeOffset) frskyHubData.baroAltitudeOffset = -frskyHubData.baroAltitude_bp; if (g_model.varioSource == VARIO_SOURCE_BARO_V1) { - evalVario(frskyHubData.baroAltitude_bp*100, 0); + evalVario(frskyHubData.baroAltitude_bp, 0); } frskyHubData.baroAltitude_bp += frskyHubData.baroAltitudeOffset; checkMinMaxAltitude();