Rev 1660 | Rev 1664 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1660 | Rev 1662 | ||
---|---|---|---|
Line 57... | Line 57... | ||
57 | #include "mymath.h" |
57 | #include "mymath.h" |
58 | #include "isqrt.h" |
58 | #include "isqrt.h" |
Line 59... | Line 59... | ||
59 | 59 | ||
60 | unsigned char h,m,s; |
60 | unsigned char h,m,s; |
61 | unsigned int BaroExpandActive = 0; |
- | |
62 | volatile unsigned int I2CTimeout = 100; |
61 | unsigned int BaroExpandActive = 0; |
63 | int MesswertNick,MesswertRoll,MesswertGier,MesswertGierBias, RohMesswertNick,RohMesswertRoll; |
62 | int MesswertNick,MesswertRoll,MesswertGier,MesswertGierBias, RohMesswertNick,RohMesswertRoll; |
64 | int TrimNick, TrimRoll; |
63 | int TrimNick, TrimRoll; |
65 | int AdNeutralNick = 0,AdNeutralRoll = 0,AdNeutralGier = 0,StartNeutralRoll = 0,StartNeutralNick = 0; |
64 | int AdNeutralNick = 0,AdNeutralRoll = 0,AdNeutralGier = 0,StartNeutralRoll = 0,StartNeutralNick = 0; |
66 | int Mittelwert_AccNick, Mittelwert_AccRoll,Mittelwert_AccHoch; |
65 | int Mittelwert_AccNick, Mittelwert_AccRoll,Mittelwert_AccHoch; |
Line 259... | Line 258... | ||
259 | Parameter_AchsKopplung1 = 0; |
258 | Parameter_AchsKopplung1 = 0; |
260 | Parameter_AchsKopplung2 = 0; |
259 | Parameter_AchsKopplung2 = 0; |
Line 261... | Line 260... | ||
261 | 260 | ||
Line 262... | Line -... | ||
262 | ExpandBaro = 0; |
- | |
263 | - | ||
264 | I2C_SendBLConfig(); |
261 | ExpandBaro = 0; |
265 | 262 | ||
Line 266... | Line 263... | ||
266 | CalibrierMittelwert(); |
263 | CalibrierMittelwert(); |
Line 542... | Line 539... | ||
542 | DebugOut.Analog[13] = Motor[1].SetPoint; |
539 | DebugOut.Analog[13] = Motor[1].SetPoint; |
543 | DebugOut.Analog[14] = Motor[2].SetPoint; |
540 | DebugOut.Analog[14] = Motor[2].SetPoint; |
544 | DebugOut.Analog[15] = Motor[3].SetPoint; |
541 | DebugOut.Analog[15] = Motor[3].SetPoint; |
Line 545... | Line 542... | ||
545 | 542 | ||
546 | //Start I2C Interrupt Mode |
- | |
547 | twi_state = 0; |
543 | //Start I2C Interrupt Mode |
548 | motor = 0; |
544 | motor_write = 0; |
549 | I2C_Start(); |
545 | I2C_Start(TWI_STATE_MOTOR_TX); |
Line 550... | Line 546... | ||
550 | } |
546 | } |