55,6 → 55,7 |
unsigned char SenderOkay = 0; |
unsigned int I2CTimeout = 100; |
char MotorenEin = 0; |
unsigned int modell_fliegt = 0; |
|
extern unsigned long maxDistance; |
extern signed int GPS_Nick, GPS_Roll; |
75,6 → 76,7 |
**************************************************************************** */ |
void SetNeutral(void) |
{ |
beeptime = 2000; |
Delay_ms(1000); |
if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)) // Höhenregelung aktiviert? |
{ |
167,16 → 169,36 |
LastAltitude = CurrentAltitude; |
} |
AirPressureCnt++; |
|
//if ((GPS_Roll == 0 && GPS_Nick == 0) || (maxDistance / 10 > 10)) |
|
if(modell_fliegt < 0x250) |
{ |
//if ((GPS_Roll == 0 && GPS_Nick == 0) || (maxDistance / 10 > 10)) |
AdNeutralNick = 0.998F * AdNeutralNick + 0.002F * AdWertNick_Raw; |
AdNeutralRoll = 0.998F * AdNeutralRoll + 0.002F * AdWertRoll_Raw; |
if (abs(StickGier) < 15 || MotorenEin == 0) |
{ |
AdNeutralGier = 0.998F * AdNeutralGier + 0.002F * AdWertGier_Raw; |
} |
} |
else if(modell_fliegt < 0x2000) |
{ |
//if ((GPS_Roll == 0 && GPS_Nick == 0) || (maxDistance / 10 > 10)) |
AdNeutralNick = 0.999F * AdNeutralNick + 0.001F * AdWertNick_Raw; |
AdNeutralRoll = 0.999F * AdNeutralRoll + 0.001F * AdWertRoll_Raw; |
if (abs(StickGier) < 15 || MotorenEin == 0) |
{ |
AdNeutralGier = 0.999F * AdNeutralGier + 0.001F * AdWertGier_Raw; |
AdNeutralGier = 0.999F * AdNeutralGier + 0.001F * AdWertGier_Raw; |
} |
} |
else |
{ |
AdNeutralNick = 0.9995F * AdNeutralNick + 0.0005F * AdWertNick_Raw; |
AdNeutralRoll = 0.9995F * AdNeutralRoll + 0.0005F * AdWertRoll_Raw; |
if (abs(StickGier) < 15 || MotorenEin == 0) |
{ |
AdNeutralGier = 0.9995F * AdNeutralGier + 0.0005F * AdWertGier_Raw; |
} |
} |
|
#if 1 |
DebugOut.Analog[6] = AdWertNick_Raw; |
187,7 → 209,7 |
DebugOut.Analog[10] = AdNeutralRoll; |
DebugOut.Analog[11] = AdNeutralGier; |
#endif |
|
|
AccumulatedRoll = 0; |
AccumulatedRoll_cnt = 0; |
AccumulatedNick = 0; |
258,7 → 280,6 |
{ |
static unsigned char delay_neutral = 0; |
static unsigned char delay_einschalten = 0,delay_ausschalten = 0; |
static unsigned int modell_fliegt = 0; |
|
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
// Gaswert ermitteln |