Subversion Repositories FlightCtrl

Rev

Rev 2492 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1 ingob 1
/*#######################################################################################
2
Flight Control
3
#######################################################################################*/
4
 
5
#ifndef _FC_H
6
#define _FC_H
1111 hbuss 7
//#define GIER_GRAD_FAKTOR 1291L // Abhängigkeit zwischen GyroIntegral und Winkel
1243 killagreg 8
//#define GIER_GRAD_FAKTOR 1160L
1121 hbuss 9
extern long GIER_GRAD_FAKTOR; // Abhängigkeit zwischen GyroIntegral und Winkel
855 hbuss 10
#define STICK_GAIN 4
1703 holgerb 11
#define ACC_AMPLIFY    6
2390 holgerb 12
#define HEIGHT_CONTROL_STICKTHRESHOLD 15
921 hbuss 13
 
1916 holgerb 14
// FC_StatusFlags
1765 killagreg 15
#define FC_STATUS_MOTOR_RUN                             0x01
16
#define FC_STATUS_FLY                                   0x02
17
#define FC_STATUS_CALIBRATE                             0x04
18
#define FC_STATUS_START                                 0x08
19
#define FC_STATUS_EMERGENCY_LANDING             0x10
20
#define FC_STATUS_LOWBAT                                0x20
1767 killagreg 21
#define FC_STATUS_VARIO_TRIM_UP                 0x40
22
#define FC_STATUS_VARIO_TRIM_DOWN               0x80
1254 killagreg 23
 
2040 holgerb 24
// FC_StatusFlags2 
1861 holgerb 25
#define FC_STATUS2_CAREFREE                 0x01
26
#define FC_STATUS2_ALTITUDE_CONTROL         0x02
1916 holgerb 27
#define FC_STATUS2_RC_FAILSAVE_ACTIVE       0x04
2040 holgerb 28
#define FC_STATUS2_OUT1_ACTIVE                  0x08
29
#define FC_STATUS2_OUT2_ACTIVE                  0x10
2309 holgerb 30
#define FC_STATUS2_WAIT_FOR_TAKEOFF             0x20   // Motor Running, but still on the ground
2340 holgerb 31
#define FC_STATUS2_AUTO_STARTING                0x40
32
#define FC_STATUS2_AUTO_LANDING                 0x80
1702 holgerb 33
 
2482 holgerb 34
// FC_StatusFlags3 
35
#define FC_STATUS3_REDUNDANCE               0x01
36
#define FC_STATUS3_BOAT                         0x02
37
 
2009 holgerb 38
//NC_To_FC_Flags
39
#define NC_TO_FC_FLYING_RANGE           0x01
40
#define NC_TO_FC_EMERGENCY_LANDING      0x02
2322 holgerb 41
#define NC_TO_FC_AUTOSTART                      0x04
42
#define NC_TO_FC_AUTOLANDING            0x08 // not used 
2482 holgerb 43
#define NC_TO_FC_SIMULATION_ACTIVE      0x10 // don't start motors
2009 holgerb 44
 
1861 holgerb 45
extern volatile unsigned char FC_StatusFlags, FC_StatusFlags2;
2482 holgerb 46
extern unsigned char FC_StatusFlags3;
1862 holgerb 47
extern void ParameterZuordnung(void);
2342 holgerb 48
extern unsigned char GetChannelValue(unsigned char ch); // gives the unsigned value of the channel
1861 holgerb 49
 
1377 hbuss 50
#define Poti1 Poti[0]
51
#define Poti2 Poti[1]
52
#define Poti3 Poti[2]
53
#define Poti4 Poti[3]
54
#define Poti5 Poti[4]
55
#define Poti6 Poti[5]
56
#define Poti7 Poti[6]
57
#define Poti8 Poti[7]
1254 killagreg 58
 
2191 holgerb 59
#define LIMIT_MIN(value, min) {if(value <= min) value = min;}
60
#define LIMIT_MAX(value, max) {if(value >= max) value = max;}
61
#define LIMIT_MIN_MAX(value, min, max) {if(value <= min) value = min; else if(value >= max) value = max;}
62
 
1921 holgerb 63
#define CHK_POTI(b,a) {if(a < 248) b = a; else b = Poti[255 - a];}
1933 holgerb 64
#define CHK_POTI_OFF(b,a,off) {if(a < 248) b = a; else b = Poti[255 - a] - off;}
1921 holgerb 65
#define CHK_POTI_MM(b,a,min,max) {CHK_POTI(b,a); LIMIT_MIN_MAX(b, min, max);}
1933 holgerb 66
#define CHK_POTI_MM_OFF(b,a,min,max,off) {CHK_POTI_OFF(b,a,off); LIMIT_MIN_MAX(b, min, max);}
1921 holgerb 67
 
1 ingob 68
extern unsigned char Sekunde,Minute;
1352 hbuss 69
extern unsigned int BaroExpandActive;
2482 holgerb 70
extern long IntegralNick;//,IntegralNick2;
71
extern long IntegralRoll;//,IntegralRoll2;
1153 hbuss 72
//extern int IntegralNick,IntegralNick2;
73
//extern int IntegralRoll,IntegralRoll2;
1420 killagreg 74
extern unsigned char Poti[9];
1153 hbuss 75
 
2482 holgerb 76
extern long Mess_IntegralNick;//,Mess_IntegralNick2;
77
extern long Mess_IntegralRoll;//,Mess_IntegralRoll2;
693 hbuss 78
extern long IntegralAccNick,IntegralAccRoll;
1685 holgerb 79
extern long SummeNick,SummeRoll;
1 ingob 80
extern volatile long Mess_Integral_Hoch;
693 hbuss 81
extern long Integral_Gier,Mess_Integral_Gier,Mess_Integral_Gier2;
1153 hbuss 82
extern int  KompassValue;
1837 holgerb 83
extern int  KompassSollWert;
1153 hbuss 84
extern int  KompassRichtung;
1839 holgerb 85
extern char CalculateCompassTimer;
86
extern unsigned char KompassFusion;
1664 holgerb 87
extern unsigned char ControlHeading;
1166 hbuss 88
extern int  TrimNick, TrimRoll;
717 hbuss 89
extern long  ErsatzKompass;
2437 holgerb 90
extern int   ErsatzKompassInGrad,CompassCorrected; // Kompasswert in Grad
1246 killagreg 91
extern long HoehenWert;
92
extern long SollHoehe;
1855 holgerb 93
extern long FromNC_AltitudeSetpoint;
94
extern unsigned char FromNC_AltitudeSpeed;
1921 holgerb 95
extern unsigned char Parameter_HoehenSchalter;      // Wert : 0-250
1690 holgerb 96
extern unsigned char CareFree;
1153 hbuss 97
extern int MesswertNick,MesswertRoll,MesswertGier;
1703 holgerb 98
extern int AdNeutralNick,AdNeutralRoll,AdNeutralGier, Mittelwert_AccNick, Mittelwert_AccRoll;
1643 holgerb 99
extern unsigned int NeutralAccX, NeutralAccY;
1215 hbuss 100
extern unsigned char HoehenReglerAktiv;
1639 holgerb 101
extern int NeutralAccZ;
2316 holgerb 102
extern signed char NeutralAccZfine;
396 hbuss 103
extern long Umschlag180Nick, Umschlag180Roll;
492 hbuss 104
extern signed int ExternStickNick,ExternStickRoll,ExternStickGier;
513 hbuss 105
extern unsigned char Parameter_UserParam1,Parameter_UserParam2,Parameter_UserParam3,Parameter_UserParam4,Parameter_UserParam5,Parameter_UserParam6,Parameter_UserParam7,Parameter_UserParam8;
805 hbuss 106
extern int NaviAccNick,NaviAccRoll,NaviCntAcc;
871 hbuss 107
extern unsigned int modell_fliegt;
1639 holgerb 108
extern void MotorRegler(void);
109
extern void SendMotorData(void);
1622 killagreg 110
//void CalibrierMittelwert(void);
111
//void Mittelwert(void);
2316 holgerb 112
extern unsigned char SetNeutral(unsigned char AccAdjustment);  // retuns: "sucess"
1639 holgerb 113
extern void Piep(unsigned char Anzahl, unsigned int dauer);
114
extern void CopyDebugValues(void);
2309 holgerb 115
extern unsigned char ACC_AltitudeControl;
116
extern signed int CosAttitude;  // for projection of hoover gas
1 ingob 117
 
304 ingob 118
extern unsigned char h,m,s;
1943 holgerb 119
extern int StickNick,StickRoll,StickGier,StickGas;
304 ingob 120
extern volatile unsigned char Timeout ;
121
extern unsigned char CosinusNickWinkel, CosinusRollWinkel;
1153 hbuss 122
extern int  DiffNick,DiffRoll;
1377 hbuss 123
//extern int  Poti1, Poti2, Poti3, Poti4;
304 ingob 124
extern volatile unsigned char SenderOkay;
125
extern int StickNick,StickRoll,StickGier;
126
extern char MotorenEin;
2009 holgerb 127
extern unsigned char CalibrationDone;
1403 hbuss 128
extern unsigned char Parameter_Servo3,Parameter_Servo4,Parameter_Servo5;
1591 holgerb 129
extern char VarioCharacter;
1942 holgerb 130
extern signed int AltitudeSetpointTrimming;
131
extern signed char WaypointTrimming;
1692 holgerb 132
extern int HoverGas;
1 ingob 133
extern unsigned char Parameter_Luftdruck_D;
2342 holgerb 134
//extern unsigned char Parameter_MaxHoehe;
1 ingob 135
extern unsigned char Parameter_Hoehe_P;
136
extern unsigned char Parameter_Hoehe_ACC_Wirkung;
137
extern unsigned char Parameter_KompassWirkung;
138
extern unsigned char Parameter_Gyro_P;
139
extern unsigned char Parameter_Gyro_I;
140
extern unsigned char Parameter_Gier_P;
141
extern unsigned char Parameter_ServoNickControl;
1232 hbuss 142
extern unsigned char Parameter_ServoRollControl;
2296 holgerb 143
extern unsigned char Parameter_ServoNickComp;
144
extern unsigned char Parameter_ServoRollComp;
396 hbuss 145
extern unsigned char Parameter_AchsKopplung1;
1120 hbuss 146
extern unsigned char Parameter_AchsKopplung2;
147
//extern unsigned char Parameter_AchsGegenKopplung1;
921 hbuss 148
extern unsigned char Parameter_J16Bitmask;             // for the J16 Output
149
extern unsigned char Parameter_J16Timing;              // for the J16 Output
150
extern unsigned char Parameter_J17Bitmask;             // for the J17 Output
151
extern unsigned char Parameter_J17Timing;              // for the J17 Output
1916 holgerb 152
extern unsigned char Parameter_GlobalConfig;
153
extern unsigned char Parameter_ExtraConfig;
1243 killagreg 154
extern signed char MixerTable[MAX_MOTORS][4];
1760 holgerb 155
extern const signed char sintab[31];
2390 holgerb 156
extern unsigned char LowVoltageLandingActive;
2408 holgerb 157
extern unsigned char LowVoltageHomeActive;
2447 holgerb 158
extern unsigned char Parameter_MaximumAltitude;
1 ingob 159
#endif //_FC_H
160