Rev 2322 | Rev 2332 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2322 | Rev 2330 | ||
---|---|---|---|
Line 343... | Line 343... | ||
343 | NeutralAccX = abs(Mittelwert_AccNick) / (2*ACC_AMPLIFY); |
343 | NeutralAccX = abs(Mittelwert_AccNick) / (2*ACC_AMPLIFY); |
344 | NeutralAccY = abs(Mittelwert_AccRoll) / (2*ACC_AMPLIFY); |
344 | NeutralAccY = abs(Mittelwert_AccRoll) / (2*ACC_AMPLIFY); |
345 | sucess = 0; |
345 | sucess = 0; |
346 | } |
346 | } |
347 | } |
347 | } |
- | 348 | EEAR = EE_DUMMY; // Set the EEPROM Address pointer to an unused space |
|
348 | MesswertNick = 0; |
349 | MesswertNick = 0; |
349 | MesswertRoll = 0; |
350 | MesswertRoll = 0; |
350 | MesswertGier = 0; |
351 | MesswertGier = 0; |
351 | Delay_ms_Mess(100); |
352 | Delay_ms_Mess(100); |
352 | Mittelwert_AccNick = ACC_AMPLIFY * AdWertAccNick; |
353 | Mittelwert_AccNick = ACC_AMPLIFY * AdWertAccNick; |
353 | Mittelwert_AccRoll = ACC_AMPLIFY * AdWertAccRoll; |
354 | Mittelwert_AccRoll = ACC_AMPLIFY * AdWertAccRoll; |
Line 397... | Line 398... | ||
397 | NeutralAccZ = (long)((long) (NeutralAccZ - 512) * 8192 + 4096) / CosAttitude + 512; |
398 | NeutralAccZ = (long)((long) (NeutralAccZ - 512) * 8192 + 4096) / CosAttitude + 512; |
398 | if(tilt1 > 20) sucess = 0; // calibration must be within 20° Tilt angle |
399 | if(tilt1 > 20) sucess = 0; // calibration must be within 20° Tilt angle |
399 | if(AdjustmentMode != 0 && ACC_AltitudeControl) if((NeutralAccZ < 682 - 25) || (NeutralAccZ > 682 + 25)) { VersionInfo.HardwareError[0] |= FC_ERROR0_ACC_TOP; sucess = 0;}; |
400 | if(AdjustmentMode != 0 && ACC_AltitudeControl) if((NeutralAccZ < 682 - 25) || (NeutralAccZ > 682 + 25)) { VersionInfo.HardwareError[0] |= FC_ERROR0_ACC_TOP; sucess = 0;}; |
400 | #else |
401 | #else |
401 | NeutralAccZ = (int16_t)GetParamWord(PID_ACC_TOP); |
402 | NeutralAccZ = (int16_t)GetParamWord(PID_ACC_TOP); |
- | 403 | EEAR = EE_DUMMY; // Set the EEPROM Address pointer to an unused space |
|
402 | #endif |
404 | #endif |
Line 403... | Line 405... | ||
403 | 405 | ||
404 | if((AdNeutralNick < 150 * 16) || (AdNeutralNick > 850 * 16)) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_NICK; }; |
406 | if((AdNeutralNick < 150 * 16) || (AdNeutralNick > 850 * 16)) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_NICK; }; |
405 | if((AdNeutralRoll < 150 * 16) || (AdNeutralRoll > 850 * 16)) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_ROLL; }; |
407 | if((AdNeutralRoll < 150 * 16) || (AdNeutralRoll > 850 * 16)) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_ROLL; }; |