Subversion Repositories FlightCtrl

Rev

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
886 killagreg 7
 
8
#include <inttypes.h>
9
 
10
#define YAW_GYRO_DEG_FACTOR 1550L // Factor between Yaw Gyro Integral and HeadingAngle in deg
855 hbuss 11
#define STICK_GAIN 4
886 killagreg 12
 
13
typedef struct
14
{
15
        uint8_t Height_D;
16
        uint8_t MaxHeight;
17
        uint8_t Height_P;
18
        uint8_t Height_ACC_Effect;
19
        uint8_t CompassYawEffect;
20
        uint8_t Gyro_P;
21
        uint8_t Gyro_I;
22
        uint8_t Gier_P;
23
        uint8_t I_Factor;
24
        uint8_t UserParam1;
25
        uint8_t UserParam2;
26
        uint8_t UserParam3;
27
        uint8_t UserParam4;
28
        uint8_t UserParam5;
29
        uint8_t UserParam6;
30
        uint8_t UserParam7;
31
        uint8_t UserParam8;
911 killagreg 32
        uint8_t ServoNickControl;
33
        uint8_t LoopGasLimit;
886 killagreg 34
        uint8_t Yaw_PosFeedback;
35
        uint8_t Yaw_NegFeedback;
36
        uint8_t DynamicStability;
37
} fc_param_t;
38
 
39
extern fc_param_t FCParam;
40
 
41
extern volatile uint16_t I2CTimeout;
42
 
43
// attitude
911 killagreg 44
extern volatile int32_t IntegralNick, IntegralRoll, IntegralYaw;
45
extern volatile int16_t Reading_GyroNick, Reading_GyroRoll, Reading_GyroYaw;
886 killagreg 46
 
47
// offsets
911 killagreg 48
extern volatile int16_t AdNeutralNick, AdNeutralRoll, AdNeutralYaw;
886 killagreg 49
extern volatile int16_t NeutralAccX, NeutralAccY;
1 ingob 50
extern volatile float NeutralAccZ;
886 killagreg 51
 
52
 
53
extern volatile int32_t Reading_Integral_Top; // calculated in analog.c
54
 
55
// compass navigation
56
extern volatile int16_t CompassHeading;
57
extern volatile int16_t CompassCourse;
58
extern volatile int16_t CompassOffCourse;
59
extern volatile uint8_t CompassCalState;
60
extern int32_t YawGyroHeading;
61
extern int16_t YawGyroHeadingInDeg;
62
 
63
// hight control
64
extern int ReadingHeight;
65
extern int SetPointHeight;
66
 
67
// mean accelerations
911 killagreg 68
extern volatile int16_t Mean_AccNick, Mean_AccRoll, Mean_AccTop;
886 killagreg 69
 
70
// acceleration send to navi board
911 killagreg 71
extern int16_t NaviAccNick, NaviAccRoll, NaviCntAcc;
886 killagreg 72
 
73
 
74
// looping params
911 killagreg 75
extern long TurnOver180Nick, TurnOver180Roll;
886 killagreg 76
 
77
// external control
911 killagreg 78
extern int16_t ExternStickNick, ExternStickRoll, ExternStickYaw;
886 killagreg 79
 
80
 
81
void MotorControl(void);
1 ingob 82
void SendMotorData(void);
886 killagreg 83
void CalibMean(void);
84
void Mean(void);
1 ingob 85
void SetNeutral(void);
886 killagreg 86
void Beep(uint8_t numbeeps);
1 ingob 87
 
88
 
886 killagreg 89
extern int16_t  Poti1, Poti2, Poti3, Poti4, Poti5, Poti6, Poti7, Poti8;
499 hbuss 90
 
886 killagreg 91
// setpoints for motors
92
extern volatile uint8_t Motor_Front, Motor_Rear, Motor_Right, Motor_Left; //used by twimaster isr
1 ingob 93
 
886 killagreg 94
// current stick values
911 killagreg 95
extern int16_t StickNick;
886 killagreg 96
extern int16_t StickRoll;
97
extern int16_t StickYaw;
911 killagreg 98
extern int16_t GPS_Nick;
886 killagreg 99
extern int16_t GPS_Roll;
396 hbuss 100
 
886 killagreg 101
// current stick elongations
911 killagreg 102
extern int16_t MaxStickNick, MaxStickRoll, MaxStickYaw;
886 killagreg 103
extern uint8_t MotorsOn;
104
extern uint8_t EmergencyLanding;
105
extern uint16_t Model_Is_Flying;
1 ingob 106
 
107
 
108
#endif //_FC_H
109