Vario fix
This commit is contained in:
+2
-2
@@ -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;
|
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);
|
int32_t varioAltitude_cm = (int32_t)altitude_bp * 100 + (altitude_bp > 0 ? altitude_ap : -altitude_ap);
|
||||||
uint8_t varioAltitudeQueuePointer = frskyHubData.varioAltitudeQueuePointer + 1;
|
uint8_t varioAltitudeQueuePointer = frskyHubData.varioAltitudeQueuePointer + 1;
|
||||||
@@ -274,7 +274,7 @@ void parseTelemHubByte(uint8_t byte)
|
|||||||
if (!frskyHubData.baroAltitudeOffset)
|
if (!frskyHubData.baroAltitudeOffset)
|
||||||
frskyHubData.baroAltitudeOffset = -frskyHubData.baroAltitude_bp;
|
frskyHubData.baroAltitudeOffset = -frskyHubData.baroAltitude_bp;
|
||||||
if (g_model.varioSource == VARIO_SOURCE_BARO_V1) {
|
if (g_model.varioSource == VARIO_SOURCE_BARO_V1) {
|
||||||
evalVario(frskyHubData.baroAltitude_bp*100, 0);
|
evalVario(frskyHubData.baroAltitude_bp, 0);
|
||||||
}
|
}
|
||||||
frskyHubData.baroAltitude_bp += frskyHubData.baroAltitudeOffset;
|
frskyHubData.baroAltitude_bp += frskyHubData.baroAltitudeOffset;
|
||||||
checkMinMaxAltitude();
|
checkMinMaxAltitude();
|
||||||
|
|||||||
Reference in New Issue
Block a user