From 3a981ef490b17fd81e6288cd619bff539dc4c3e3 Mon Sep 17 00:00:00 2001 From: "maxim.karban@gmail.com" Date: Sat, 28 Apr 2012 14:34:16 +0000 Subject: [PATCH] evalVario() optimized --- src/frsky.cpp | 5 ++--- 1 file changed, 2 insertions(+), 3 deletions(-) diff --git a/src/frsky.cpp b/src/frsky.cpp index ce85a7796..35e1d1434 100644 --- a/src/frsky.cpp +++ b/src/frsky.cpp @@ -169,8 +169,7 @@ int16_t applyChannelRatio(uint8_t channel, int16_t val) inline 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); - + int32_t varioAltitude_cm = (int32_t)altitude_bp * 100 + altitude_ap; uint8_t varioAltitudeQueuePointer = frskyHubData.varioAltitudeQueuePointer + 1; if (varioAltitudeQueuePointer == VARIO_QUEUE_LENGTH) varioAltitudeQueuePointer = 0; @@ -276,7 +275,7 @@ void parseTelemHubByte(uint8_t byte) case offsetof(FrskyHubData, baroAltitude_ap): if (g_model.varioSource == VARIO_SOURCE_BARO) { - evalVario(frskyHubData.baroAltitude_bp-frskyHubData.baroAltitudeOffset, frskyHubData.baroAltitude_ap); + evalVario(frskyHubData.baroAltitude_bp, frskyHubData.baroAltitude_ap); } break;