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

VARIO option introduced

Browse Source
This commit is contained in:
bsongis
2012-05-10 16:57:41 +00:00
parent 0f780eca35
commit aabe510663
4 changed files with 33 additions and 17 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/frsky.cpp
+3 -1
View File
@@ -170,6 +170,7 @@ int16_t applyChannelRatio(uint8_t channel, int16_t val)
void evalVario(int16_t altitude_bp, uint16_t altitude_ap)
{
#if defined(VARIO)
int32_t varioAltitude_cm = (int32_t)altitude_bp * 100 + (altitude_bp > 0 ? altitude_ap : -altitude_ap);
uint8_t varioAltitudeQueuePointer = frskyHubData.varioAltitudeQueuePointer + 1;
if (varioAltitudeQueuePointer == VARIO_QUEUE_LENGTH)
@@ -179,6 +180,7 @@ void evalVario(int16_t altitude_bp, uint16_t altitude_ap)
frskyHubData.varioAltitudeQueue[varioAltitudeQueuePointer] = varioAltitude_cm - frskyHubData.varioAltitude_cm;
frskyHubData.varioAltitude_cm = varioAltitude_cm;
frskyHubData.varioSpeed += frskyHubData.varioAltitudeQueue[varioAltitudeQueuePointer] ;
#endif
}
void checkMinMaxAltitude()
@@ -642,7 +644,7 @@ void check_frsky()
}
#endif
#if defined(FRSKY_HUB) || defined(WS_HOW_HIGH)
#if defined(VARIO)
static uint16_t s_varioTmr = 0;
if (isFunctionActive(FUNC_VARIO)) {
#if defined(AUDIO)