piotr/edgetx-gx12
1
0
Fork 0
Code Issues 2 Pull Requests Actions Packages Projects Releases Wiki Activity

Vario fix

Browse Source
This commit is contained in:
bsongis
2012-05-08 21:08:12 +00:00
parent a96785cca7
commit 571be5bf77
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/frsky.cpp
+2 -2
View File
@@ -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();