Rev 342 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 342 | Rev 343 | ||
|---|---|---|---|
| Line 173... | Line 173... | ||
| 173 | 173 | ||
| 174 | // Wenn Gas zurück genommen wird, Kalibrierung mit Verzögerung beenden |
174 | // Wenn Gas zurück genommen wird, Kalibrierung mit Verzögerung beenden |
| 175 | if (PPM_in[EE_Parameter.Kanalbelegung[K_GAS]] < 100) measurement--; |
175 | if (PPM_in[EE_Parameter.Kanalbelegung[K_GAS]] < 100) measurement--; |
| Line -... | Line 176... | ||
| - | 176 | } |
|
| 176 | } |
177 | |
| 177 | 178 | // Offset der Achsen berechnen |
|
| 178 | X_off = (x_max + x_min) / 2; |
179 | X_off = (x_max + x_min) / 2; |
| Line -... | Line 180... | ||
| - | 180 | Y_off = (y_max + y_min) / 2; |
|
| 179 | Y_off = (y_max + y_min) / 2; |
181 | Z_off = (z_max + z_min) / 2; |
| 180 | Z_off = (z_max + z_min) / 2; |
182 | |
| 181 | 183 | // und im EEProm abspeichern |
|
| Line 182... | Line 184... | ||
| 182 | eeprom_write_byte(&Kompass_Offset[0], X_off); |
184 | eeprom_write_byte(&Kompass_Offset[0], X_off); |
| Line 199... | Line 201... | ||
| 199 | sin_nick = sin_f(MM3.NickGrad); |
201 | sin_nick = sin_f(MM3.NickGrad); |
| 200 | cos_nick = cos_f(MM3.NickGrad); |
202 | cos_nick = cos_f(MM3.NickGrad); |
| 201 | sin_roll = sin_f(MM3.RollGrad); |
203 | sin_roll = sin_f(MM3.RollGrad); |
| 202 | cos_roll = cos_f(MM3.RollGrad); |
204 | cos_roll = cos_f(MM3.RollGrad); |
| Line 203... | Line 205... | ||
| 203 | 205 | ||
| 204 | // Kompasskalibrierung berücksichtigen |
206 | // Offset der Achsen nur bei Bedarf (also hier) berücksichtigen |
| 205 | x_axis = MM3.x_axis - X_off; |
207 | x_axis = MM3.x_axis - X_off; |
| 206 | y_axis = MM3.y_axis - Y_off; |
208 | y_axis = MM3.y_axis - Y_off; |
| Line 207... | Line 209... | ||
| 207 | z_axis = MM3.z_axis - Z_off; |
209 | z_axis = MM3.z_axis - Z_off; |