Subversion Repositories FlightCtrl

Rev

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
}