Go to most recent revision | Details | 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 |
2530 | holgerb | 35 | #define FC_STATUS3_REDUNDANCE_AKTIVE 0x01 |
2482 | holgerb | 36 | #define FC_STATUS3_BOAT 0x02 |
2530 | holgerb | 37 | #define FC_STATUS3_REDUNDANCE_ERROR 0x04 |
38 | #define FC_STATUS3_REDUNDANCE_TEST 0x08 |
||
2482 | holgerb | 39 | |
2009 | holgerb | 40 | //NC_To_FC_Flags |
41 | #define NC_TO_FC_FLYING_RANGE 0x01 |
||
42 | #define NC_TO_FC_EMERGENCY_LANDING 0x02 |
||
2322 | holgerb | 43 | #define NC_TO_FC_AUTOSTART 0x04 |
44 | #define NC_TO_FC_AUTOLANDING 0x08 // not used |
||
2482 | holgerb | 45 | #define NC_TO_FC_SIMULATION_ACTIVE 0x10 // don't start motors |
2009 | holgerb | 46 | |
1861 | holgerb | 47 | extern volatile unsigned char FC_StatusFlags, FC_StatusFlags2; |
2482 | holgerb | 48 | extern unsigned char FC_StatusFlags3; |
1862 | holgerb | 49 | extern void ParameterZuordnung(void); |
2342 | holgerb | 50 | extern unsigned char GetChannelValue(unsigned char ch); // gives the unsigned value of the channel |
2499 | holgerb | 51 | extern void ChannelAssingment(void); |
1861 | holgerb | 52 | |
1377 | hbuss | 53 | #define Poti1 Poti[0] |
54 | #define Poti2 Poti[1] |
||
55 | #define Poti3 Poti[2] |
||
56 | #define Poti4 Poti[3] |
||
57 | #define Poti5 Poti[4] |
||
58 | #define Poti6 Poti[5] |
||
59 | #define Poti7 Poti[6] |
||
60 | #define Poti8 Poti[7] |
||
1254 | killagreg | 61 | |
2191 | holgerb | 62 | #define LIMIT_MIN(value, min) {if(value <= min) value = min;} |
63 | #define LIMIT_MAX(value, max) {if(value >= max) value = max;} |
||
64 | #define LIMIT_MIN_MAX(value, min, max) {if(value <= min) value = min; else if(value >= max) value = max;} |
||
65 | |||
1921 | holgerb | 66 | #define CHK_POTI(b,a) {if(a < 248) b = a; else b = Poti[255 - a];} |
1933 | holgerb | 67 | #define CHK_POTI_OFF(b,a,off) {if(a < 248) b = a; else b = Poti[255 - a] - off;} |
1921 | holgerb | 68 | #define CHK_POTI_MM(b,a,min,max) {CHK_POTI(b,a); LIMIT_MIN_MAX(b, min, max);} |
1933 | holgerb | 69 | #define CHK_POTI_MM_OFF(b,a,min,max,off) {CHK_POTI_OFF(b,a,off); LIMIT_MIN_MAX(b, min, max);} |
1921 | holgerb | 70 | |
1 | ingob | 71 | extern unsigned char Sekunde,Minute; |
1352 | hbuss | 72 | extern unsigned int BaroExpandActive; |
2482 | holgerb | 73 | extern long IntegralNick;//,IntegralNick2; |
74 | extern long IntegralRoll;//,IntegralRoll2; |
||
1153 | hbuss | 75 | //extern int IntegralNick,IntegralNick2; |
76 | //extern int IntegralRoll,IntegralRoll2; |
||
1420 | killagreg | 77 | extern unsigned char Poti[9]; |
1153 | hbuss | 78 | |
2482 | holgerb | 79 | extern long Mess_IntegralNick;//,Mess_IntegralNick2; |
80 | extern long Mess_IntegralRoll;//,Mess_IntegralRoll2; |
||
693 | hbuss | 81 | extern long IntegralAccNick,IntegralAccRoll; |
1685 | holgerb | 82 | extern long SummeNick,SummeRoll; |
1 | ingob | 83 | extern volatile long Mess_Integral_Hoch; |
693 | hbuss | 84 | extern long Integral_Gier,Mess_Integral_Gier,Mess_Integral_Gier2; |
1153 | hbuss | 85 | extern int KompassValue; |
2497 | holgerb | 86 | extern int KompassSollWert,NC_CompassSetpoint; |
1153 | hbuss | 87 | extern int KompassRichtung; |
1839 | holgerb | 88 | extern char CalculateCompassTimer; |
89 | extern unsigned char KompassFusion; |
||
1664 | holgerb | 90 | extern unsigned char ControlHeading; |
1166 | hbuss | 91 | extern int TrimNick, TrimRoll; |
717 | hbuss | 92 | extern long ErsatzKompass; |
2437 | holgerb | 93 | extern int ErsatzKompassInGrad,CompassCorrected; // Kompasswert in Grad |
1246 | killagreg | 94 | extern long HoehenWert; |
95 | extern long SollHoehe; |
||
1855 | holgerb | 96 | extern long FromNC_AltitudeSetpoint; |
97 | extern unsigned char FromNC_AltitudeSpeed; |
||
1921 | holgerb | 98 | extern unsigned char Parameter_HoehenSchalter; // Wert : 0-250 |
1690 | holgerb | 99 | extern unsigned char CareFree; |
1153 | hbuss | 100 | extern int MesswertNick,MesswertRoll,MesswertGier; |
1703 | holgerb | 101 | extern int AdNeutralNick,AdNeutralRoll,AdNeutralGier, Mittelwert_AccNick, Mittelwert_AccRoll; |
2499 | holgerb | 102 | extern int BoatNeutralNick,BoatNeutralRoll,BoatNeutralGier; |
1643 | holgerb | 103 | extern unsigned int NeutralAccX, NeutralAccY; |
1215 | hbuss | 104 | extern unsigned char HoehenReglerAktiv; |
1639 | holgerb | 105 | extern int NeutralAccZ; |
2316 | holgerb | 106 | extern signed char NeutralAccZfine; |
396 | hbuss | 107 | extern long Umschlag180Nick, Umschlag180Roll; |
513 | hbuss | 108 | extern unsigned char Parameter_UserParam1,Parameter_UserParam2,Parameter_UserParam3,Parameter_UserParam4,Parameter_UserParam5,Parameter_UserParam6,Parameter_UserParam7,Parameter_UserParam8; |
805 | hbuss | 109 | extern int NaviAccNick,NaviAccRoll,NaviCntAcc; |
871 | hbuss | 110 | extern unsigned int modell_fliegt; |
1639 | holgerb | 111 | extern void MotorRegler(void); |
112 | extern void SendMotorData(void); |
||
1622 | killagreg | 113 | //void CalibrierMittelwert(void); |
114 | //void Mittelwert(void); |
||
2316 | holgerb | 115 | extern unsigned char SetNeutral(unsigned char AccAdjustment); // retuns: "sucess" |
1639 | holgerb | 116 | extern void Piep(unsigned char Anzahl, unsigned int dauer); |
117 | extern void CopyDebugValues(void); |
||
2309 | holgerb | 118 | extern unsigned char ACC_AltitudeControl; |
119 | extern signed int CosAttitude; // for projection of hoover gas |
||
1 | ingob | 120 | |
304 | ingob | 121 | extern unsigned char h,m,s; |
1943 | holgerb | 122 | extern int StickNick,StickRoll,StickGier,StickGas; |
304 | ingob | 123 | extern volatile unsigned char Timeout ; |
124 | extern unsigned char CosinusNickWinkel, CosinusRollWinkel; |
||
1153 | hbuss | 125 | extern int DiffNick,DiffRoll; |
1377 | hbuss | 126 | //extern int Poti1, Poti2, Poti3, Poti4; |
304 | ingob | 127 | extern volatile unsigned char SenderOkay; |
128 | extern int StickNick,StickRoll,StickGier; |
||
129 | extern char MotorenEin; |
||
2009 | holgerb | 130 | extern unsigned char CalibrationDone; |
1403 | hbuss | 131 | extern unsigned char Parameter_Servo3,Parameter_Servo4,Parameter_Servo5; |
1591 | holgerb | 132 | extern char VarioCharacter; |
1942 | holgerb | 133 | extern signed int AltitudeSetpointTrimming; |
134 | extern signed char WaypointTrimming; |
||
1692 | holgerb | 135 | extern int HoverGas; |
1 | ingob | 136 | extern unsigned char Parameter_Luftdruck_D; |
2342 | holgerb | 137 | //extern unsigned char Parameter_MaxHoehe; |
1 | ingob | 138 | extern unsigned char Parameter_Hoehe_P; |
139 | extern unsigned char Parameter_Hoehe_ACC_Wirkung; |
||
140 | extern unsigned char Parameter_KompassWirkung; |
||
141 | extern unsigned char Parameter_Gyro_P; |
||
142 | extern unsigned char Parameter_Gyro_I; |
||
143 | extern unsigned char Parameter_Gier_P; |
||
144 | extern unsigned char Parameter_ServoNickControl; |
||
1232 | hbuss | 145 | extern unsigned char Parameter_ServoRollControl; |
2296 | holgerb | 146 | extern unsigned char Parameter_ServoNickComp; |
147 | extern unsigned char Parameter_ServoRollComp; |
||
396 | hbuss | 148 | extern unsigned char Parameter_AchsKopplung1; |
1120 | hbuss | 149 | extern unsigned char Parameter_AchsKopplung2; |
150 | //extern unsigned char Parameter_AchsGegenKopplung1; |
||
921 | hbuss | 151 | extern unsigned char Parameter_J16Bitmask; // for the J16 Output |
152 | extern unsigned char Parameter_J16Timing; // for the J16 Output |
||
153 | extern unsigned char Parameter_J17Bitmask; // for the J17 Output |
||
154 | extern unsigned char Parameter_J17Timing; // for the J17 Output |
||
1916 | holgerb | 155 | extern unsigned char Parameter_GlobalConfig; |
156 | extern unsigned char Parameter_ExtraConfig; |
||
1243 | killagreg | 157 | extern signed char MixerTable[MAX_MOTORS][4]; |
1760 | holgerb | 158 | extern const signed char sintab[31]; |
2390 | holgerb | 159 | extern unsigned char LowVoltageLandingActive; |
2408 | holgerb | 160 | extern unsigned char LowVoltageHomeActive; |
2447 | holgerb | 161 | extern unsigned char Parameter_MaximumAltitude; |
2497 | holgerb | 162 | extern char NeueKompassRichtungMerken; |
2499 | holgerb | 163 | |
1 | ingob | 164 | #endif //_FC_H |
165 |