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; }; |