| 1704,7 → 1704,8 |
|---|
| |
| HCGas = GasMixFraction; // take current stick gas as neutral point for the height control |
| HeightTrimming = 0; |
| FC_StatusFlags &= ~(FC_STATUS_VARIO_TRIM_UP|FC_STATUS_VARIO_TRIM_DOWN); |
| // set undefined state to indicate vario off |
| FC_StatusFlags |= (FC_STATUS_VARIO_TRIM_UP|FC_STATUS_VARIO_TRIM_DOWN); |
| } |
| else // alternative height control |
| { |
| 1888,6 → 1889,8 |
|---|
| } |
| LIMIT_MIN_MAX(StickGasHover, 70, 150); // reserve some range for trim up and down |
| FilterHCGas = GasMixFraction; // init filter for HCGas witch current gas mix fraction |
| // set undefined state to indicate vario off |
| FC_StatusFlags |= (FC_STATUS_VARIO_TRIM_UP|FC_STATUS_VARIO_TRIM_DOWN); |
| } // EOF HC not active |
| |
| // ----------------- Hover Gas Estimation -------------------------------- |
| 1939,6 → 1942,10 |
|---|
| HoverGas = 0; |
| } // EOF not flying yet |
| }// EOF ParamSet.Config0 & CFG0_AIRPRESS_SENSOR |
| else |
| { // set undefined state to indicate vario off |
| FC_StatusFlags |= (FC_STATUS_VARIO_TRIM_UP|FC_STATUS_VARIO_TRIM_DOWN); |
| } // EOF not (ParamSet.Config0 & CFG0_AIRPRESS_SENSOR) |
| |
| // limit gas to parameter setting |
| LIMIT_MIN_MAX(GasMixFraction, (int16_t)(ParamSet.GasMin + 10) * STICK_GAIN, (int16_t)(ParamSet.GasMax - 20) * STICK_GAIN); |