Rev 366 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 366 | Rev 368 | ||
|---|---|---|---|
| Line 124... | Line 124... | ||
| 124 | //############################################################################ |
124 | //############################################################################ |
| 125 | // Neutrallage kalibrieren und fest im EEPROM abspeichern |
125 | // Neutrallage kalibrieren und fest im EEPROM abspeichern |
| 126 | void Neutral_calib(void) |
126 | void Neutral_calib(void) |
| 127 | //############################################################################ |
127 | //############################################################################ |
| 128 | { |
128 | { |
| 129 | unsigned int timer; |
129 | unsigned int timer; |
| 130 | - | ||
| - | 130 | acc_neutral.X = 0; |
|
| - | 131 | acc_neutral.Y = 0; |
|
| - | 132 | acc_neutral.Z = 0; |
|
| 131 | CalibrierMittelwert(); |
133 | CalibrierMittelwert(); |
| 132 | timer = SetDelay(5); |
134 | timer = SetDelay(5); |
| 133 | while (!CheckDelay(timer)); |
135 | while (!CheckDelay(timer)); |
| 134 | CalibrierMittelwert(); |
136 | CalibrierMittelwert(); |
| 135 | - | ||
| Line 136... | Line 137... | ||
| 136 | 137 | ||
| 137 | acc_neutral.X = abs(Mittelwert_AccNick) / ACC_AMPLIFY; |
138 | acc_neutral.X = abs(Mittelwert_AccNick) / ACC_AMPLIFY; |
| 138 | acc_neutral.Y = abs(Mittelwert_AccRoll) / ACC_AMPLIFY; |
139 | acc_neutral.Y = abs(Mittelwert_AccRoll) / ACC_AMPLIFY; |