185,7 → 185,7 |
//####################################################################################### |
{ |
static unsigned char kanal=0,state = 0; |
static signed char subcount = 0; |
//static signed char subcount = 0; // MartinR: wird nicht mehr benötigt, da deaktiviert |
static signed int gier1, roll1, nick1, nick_filter, roll_filter; |
static signed int accy, accx; |
static long tmpLuftdruck = 0; |
232,6 → 232,9 |
break; |
case 8: |
AdWertAccHoch = (signed int) ADC - NeutralAccZ; |
|
/* // MartinR: deaktivieren Anfang |
|
if(AdWertAccHoch > 1) |
{ |
if(NeutralAccZ < 750) |
250,7 → 253,10 |
if(subcount < -100) { NeutralAccZ--; subcount += 100;} |
} |
} |
// messanzahl_AccHoch = 1; |
|
*/ // MartinR: deaktivieren Ende |
|
//messanzahl_AccHoch = 1; |
Aktuell_az = ADC; |
Mess_Integral_Hoch += AdWertAccHoch; // Integrieren |
Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen |
287,7 → 293,9 |
if(PlatinenVersion == 10) nick1 *= 2; else nick1 *= 4; |
AdWertNick = nick1 / 8; |
nick_filter = (nick_filter + nick1) / 2; |
HiResNick = nick_filter - AdNeutralNick; |
//HiResNick = nick_filter - AdNeutralNick; // MartinR: so war es |
HiResNick = (nick_filter - AdNeutralNick + 4 ) / 8 ; // MartinR: + 4um Rundungsfehler zu verbessern |
// MartinR: /8 von fc.c nach hier verschoben um Code zu sparen |
AdWertNickFilter = (AdWertNickFilter + HiResNick) / 2; |
kanal = AD_ROLL; |
break; |
296,7 → 304,9 |
if(PlatinenVersion == 10) roll1 *= 2; else roll1 *= 4; |
AdWertRoll = roll1 / 8; |
roll_filter = (roll_filter + roll1) / 2; |
HiResRoll = roll_filter - AdNeutralRoll; |
//HiResRoll = roll_filter - AdNeutralRoll; // MartinR: so war es |
HiResRoll = (roll_filter - AdNeutralRoll + 4 ) / 8; // MartinR: + 4um Rundungsfehler zu verbessern |
// MartinR: /8 von fc.c nach hier verschoben um Code zu sparen |
AdWertRollFilter = (AdWertRollFilter + HiResRoll) / 2; |
kanal = AD_DRUCK; |
break; |
306,7 → 316,9 |
ZaehlMessungen++; |
// "break" fehlt hier absichtlich |
case 9: |
MessLuftdruck = ADC; |
//MessLuftdruck = ADC; // MartinR: so war es |
MessLuftdruck = ADC + ((Parameter_UserParam4 * AdWertAccHoch) / 256) ; // MartinR: |
// mit Korrektur der Beschleunigungsempfindlichkeit des Luftdrucksensors |
tmpLuftdruck += MessLuftdruck; |
if(++messanzahl_Druck >= 16) // war bis 0.86 "18" |
{ |