Subversion Repositories FlightCtrl

Rev

Rev 1669 | Rev 1690 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1669 Rev 1685
1
/*#######################################################################################
1
/*#######################################################################################
2
Flight Control
2
Flight Control
3
#######################################################################################*/
3
#######################################################################################*/
4
 
4
 
5
#ifndef _FC_H
5
#ifndef _FC_H
6
#define _FC_H
6
#define _FC_H
7
//#define GIER_GRAD_FAKTOR 1291L // Abhängigkeit zwischen GyroIntegral und Winkel
7
//#define GIER_GRAD_FAKTOR 1291L // Abhängigkeit zwischen GyroIntegral und Winkel
8
//#define GIER_GRAD_FAKTOR 1160L
8
//#define GIER_GRAD_FAKTOR 1160L
9
extern long GIER_GRAD_FAKTOR; // Abhängigkeit zwischen GyroIntegral und Winkel
9
extern long GIER_GRAD_FAKTOR; // Abhängigkeit zwischen GyroIntegral und Winkel
10
#define STICK_GAIN 4
10
#define STICK_GAIN 4
11
 
11
 
12
#define FCFLAG_MOTOR_RUN        0x01
12
#define FCFLAG_MOTOR_RUN        0x01
13
#define FCFLAG_FLY              0x02
13
#define FCFLAG_FLY              0x02
14
#define FCFLAG_CALIBRATE        0x04
14
#define FCFLAG_CALIBRATE        0x04
15
#define FCFLAG_START            0x08
15
#define FCFLAG_START            0x08
16
#define FCFLAG_NOTLANDUNG       0x10
16
#define FCFLAG_NOTLANDUNG       0x10
17
#define FCFLAG_LOWBAT           0x20
17
#define FCFLAG_LOWBAT           0x20
18
#define FCFLAG_SPI_RX_ERR       0x40
18
#define FCFLAG_SPI_RX_ERR       0x40
19
#define FCFLAG_I2CERR           0x80
19
#define FCFLAG_I2CERR           0x80
20
 
20
 
21
#define Poti1 Poti[0]
21
#define Poti1 Poti[0]
22
#define Poti2 Poti[1]
22
#define Poti2 Poti[1]
23
#define Poti3 Poti[2]
23
#define Poti3 Poti[2]
24
#define Poti4 Poti[3]
24
#define Poti4 Poti[3]
25
#define Poti5 Poti[4]
25
#define Poti5 Poti[4]
26
#define Poti6 Poti[5]
26
#define Poti6 Poti[5]
27
#define Poti7 Poti[6]
27
#define Poti7 Poti[6]
28
#define Poti8 Poti[7]
28
#define Poti8 Poti[7]
29
 
29
 
30
extern volatile unsigned char FCFlags;
30
extern volatile unsigned char FCFlags;
31
extern unsigned char Sekunde,Minute;
31
extern unsigned char Sekunde,Minute;
32
extern unsigned int BaroExpandActive;
32
extern unsigned int BaroExpandActive;
33
extern long IntegralNick,IntegralNick2;
33
extern long IntegralNick,IntegralNick2;
34
extern long IntegralRoll,IntegralRoll2;
34
extern long IntegralRoll,IntegralRoll2;
35
//extern int IntegralNick,IntegralNick2;
35
//extern int IntegralNick,IntegralNick2;
36
//extern int IntegralRoll,IntegralRoll2;
36
//extern int IntegralRoll,IntegralRoll2;
37
extern unsigned char Poti[9];
37
extern unsigned char Poti[9];
38
 
38
 
39
extern long Mess_IntegralNick,Mess_IntegralNick2;
39
extern long Mess_IntegralNick,Mess_IntegralNick2;
40
extern long Mess_IntegralRoll,Mess_IntegralRoll2;
40
extern long Mess_IntegralRoll,Mess_IntegralRoll2;
41
extern long IntegralAccNick,IntegralAccRoll;
41
extern long IntegralAccNick,IntegralAccRoll;
-
 
42
extern long SummeNick,SummeRoll;
42
extern volatile long Mess_Integral_Hoch;
43
extern volatile long Mess_Integral_Hoch;
43
extern long Integral_Gier,Mess_Integral_Gier,Mess_Integral_Gier2;
44
extern long Integral_Gier,Mess_Integral_Gier,Mess_Integral_Gier2;
44
extern int  KompassValue;
45
extern int  KompassValue;
45
extern int  KompassStartwert;
46
extern int  KompassStartwert;
46
extern int  KompassRichtung;
47
extern int  KompassRichtung;
47
extern unsigned char ControlHeading;
48
extern unsigned char ControlHeading;
48
extern int  TrimNick, TrimRoll;
49
extern int  TrimNick, TrimRoll;
49
extern long  ErsatzKompass;
50
extern long  ErsatzKompass;
50
extern int   ErsatzKompassInGrad; // Kompasswert in Grad
51
extern int   ErsatzKompassInGrad; // Kompasswert in Grad
51
extern long HoehenWert;
52
extern long HoehenWert;
52
extern long SollHoehe;
53
extern long SollHoehe;
53
extern int MesswertNick,MesswertRoll,MesswertGier;
54
extern int MesswertNick,MesswertRoll,MesswertGier;
54
extern int AdNeutralNick,AdNeutralRoll,AdNeutralGier, Mittelwert_AccNick, Mittelwert_AccRoll,Mittelwert_AccHoch;
55
extern int AdNeutralNick,AdNeutralRoll,AdNeutralGier, Mittelwert_AccNick, Mittelwert_AccRoll,Mittelwert_AccHoch;
55
extern unsigned int NeutralAccX, NeutralAccY;
56
extern unsigned int NeutralAccX, NeutralAccY;
56
extern unsigned char HoehenReglerAktiv;
57
extern unsigned char HoehenReglerAktiv;
57
extern int NeutralAccZ;
58
extern int NeutralAccZ;
58
extern long Umschlag180Nick, Umschlag180Roll;
59
extern long Umschlag180Nick, Umschlag180Roll;
59
extern signed int ExternStickNick,ExternStickRoll,ExternStickGier;
60
extern signed int ExternStickNick,ExternStickRoll,ExternStickGier;
60
extern unsigned char Parameter_UserParam1,Parameter_UserParam2,Parameter_UserParam3,Parameter_UserParam4,Parameter_UserParam5,Parameter_UserParam6,Parameter_UserParam7,Parameter_UserParam8;
61
extern unsigned char Parameter_UserParam1,Parameter_UserParam2,Parameter_UserParam3,Parameter_UserParam4,Parameter_UserParam5,Parameter_UserParam6,Parameter_UserParam7,Parameter_UserParam8;
61
extern int NaviAccNick,NaviAccRoll,NaviCntAcc;
62
extern int NaviAccNick,NaviAccRoll,NaviCntAcc;
62
extern unsigned int modell_fliegt;
63
extern unsigned int modell_fliegt;
63
extern void MotorRegler(void);
64
extern void MotorRegler(void);
64
extern void SendMotorData(void);
65
extern void SendMotorData(void);
65
//void CalibrierMittelwert(void);
66
//void CalibrierMittelwert(void);
66
//void Mittelwert(void);
67
//void Mittelwert(void);
67
extern void SetNeutral(unsigned char AccAdjustment);
68
extern void SetNeutral(unsigned char AccAdjustment);
68
extern void Piep(unsigned char Anzahl, unsigned int dauer);
69
extern void Piep(unsigned char Anzahl, unsigned int dauer);
69
extern void CopyDebugValues(void);
70
extern void CopyDebugValues(void);
70
 
71
 
71
extern unsigned char h,m,s;
72
extern unsigned char h,m,s;
72
extern volatile unsigned char Timeout ;
73
extern volatile unsigned char Timeout ;
73
extern unsigned char CosinusNickWinkel, CosinusRollWinkel;
74
extern unsigned char CosinusNickWinkel, CosinusRollWinkel;
74
extern int  DiffNick,DiffRoll;
75
extern int  DiffNick,DiffRoll;
75
//extern int  Poti1, Poti2, Poti3, Poti4;
76
//extern int  Poti1, Poti2, Poti3, Poti4;
76
extern volatile unsigned char SenderOkay;
77
extern volatile unsigned char SenderOkay;
77
extern int StickNick,StickRoll,StickGier;
78
extern int StickNick,StickRoll,StickGier;
78
extern char MotorenEin;
79
extern char MotorenEin;
79
extern unsigned char Parameter_Servo3,Parameter_Servo4,Parameter_Servo5;
80
extern unsigned char Parameter_Servo3,Parameter_Servo4,Parameter_Servo5;
80
extern char VarioCharacter;
81
extern char VarioCharacter;
81
 
82
 
82
extern unsigned char Parameter_Luftdruck_D;
83
extern unsigned char Parameter_Luftdruck_D;
83
extern unsigned char Parameter_MaxHoehe;
84
extern unsigned char Parameter_MaxHoehe;
84
extern unsigned char Parameter_Hoehe_P;
85
extern unsigned char Parameter_Hoehe_P;
85
extern unsigned char Parameter_Hoehe_ACC_Wirkung;
86
extern unsigned char Parameter_Hoehe_ACC_Wirkung;
86
extern unsigned char Parameter_KompassWirkung;
87
extern unsigned char Parameter_KompassWirkung;
87
extern unsigned char Parameter_Gyro_P;
88
extern unsigned char Parameter_Gyro_P;
88
extern unsigned char Parameter_Gyro_I;
89
extern unsigned char Parameter_Gyro_I;
89
extern unsigned char Parameter_Gier_P;
90
extern unsigned char Parameter_Gier_P;
90
extern unsigned char Parameter_ServoNickControl;
91
extern unsigned char Parameter_ServoNickControl;
91
extern unsigned char Parameter_ServoRollControl;
92
extern unsigned char Parameter_ServoRollControl;
92
extern unsigned char Parameter_AchsKopplung1;
93
extern unsigned char Parameter_AchsKopplung1;
93
extern unsigned char Parameter_AchsKopplung2;
94
extern unsigned char Parameter_AchsKopplung2;
94
//extern unsigned char Parameter_AchsGegenKopplung1;
95
//extern unsigned char Parameter_AchsGegenKopplung1;
95
extern unsigned char Parameter_J16Bitmask;             // for the J16 Output
96
extern unsigned char Parameter_J16Bitmask;             // for the J16 Output
96
extern unsigned char Parameter_J16Timing;              // for the J16 Output
97
extern unsigned char Parameter_J16Timing;              // for the J16 Output
97
extern unsigned char Parameter_J17Bitmask;             // for the J17 Output
98
extern unsigned char Parameter_J17Bitmask;             // for the J17 Output
98
extern unsigned char Parameter_J17Timing;              // for the J17 Output
99
extern unsigned char Parameter_J17Timing;              // for the J17 Output
99
extern signed char MixerTable[MAX_MOTORS][4];
100
extern signed char MixerTable[MAX_MOTORS][4];
100
#endif //_FC_H
101
#endif //_FC_H
101
 
102
 
102
 
103