Subversion Repositories FlightCtrl

Rev

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

Rev Author Line No. Line
2108 - 1
#ifndef _CONFIGURATION_H
2
#define _CONFIGURATION_H
3
 
4
#include <inttypes.h>
5
#include <avr/io.h>
6
 
2132 - 7
#define MAX_CHANNELS 8
2108 - 8
 
9
// bitmask for VersionInfo_t.HardwareError[0]
10
#define FC_ERROR0_GYRO_PITCH    0x01
11
#define FC_ERROR0_GYRO_ROLL     0x02
12
#define FC_ERROR0_GYRO_YAW      0x04
13
#define FC_ERROR0_ACC_X         0x08
14
#define FC_ERROR0_ACC_Y         0x10
15
#define FC_ERROR0_ACC_Z         0x20
16
#define FC_ERROR0_PRESSURE      0x40
17
#define FC_ERROR1_RES0          0x80
18
// bitmask for VersionInfo_t.HardwareError[1]
19
#define FC_ERROR1_I2C           0x01
20
#define FC_ERROR1_BL_MISSING    0x02
21
#define FC_ERROR1_SPI_RX        0x04
22
#define FC_ERROR1_PPM           0x08
23
#define FC_ERROR1_MIXER         0x10
24
#define FC_ERROR1_RES1          0x20
25
#define FC_ERROR1_RES2          0x40
26
#define FC_ERROR1_RES3          0x80
27
 
28
typedef struct {
29
  uint8_t gyroQuadrant;
30
  uint8_t accQuadrant;
31
  uint8_t imuReversedFlags;
32
 
33
  uint8_t gyroPIDFilterConstant;
34
  uint8_t gyroDWindowLength;
35
  uint8_t gyroDFilterConstant;
36
  uint8_t accFilterConstant;
37
 
38
  uint8_t zerothOrderCorrection;
39
  uint8_t rateTolerance;
40
 
41
  uint8_t gyroActivityDamping;
42
  uint8_t driftCompDivider; // 1/k  (Koppel_ACC_Wirkung)
43
  uint8_t driftCompLimit;   // limit for gyrodrift compensation
44
} IMUConfig_t;
45
 
46
extern IMUConfig_t IMUConfig;
47
 
48
typedef struct {
49
        uint8_t P;
50
        uint8_t I;
51
        uint8_t D;
52
} PID_t;
53
 
54
typedef struct {
55
        uint8_t P;
56
        uint8_t I;
57
        uint8_t D;
58
        uint8_t iMax;
59
} PIDIM_t;
60
 
61
typedef enum {
62
  FLIGHT_MODE_NONE,
63
  FLIGHT_MODE_MANUAL,
64
  FLIGHT_MODE_RATE,
65
  FLIGHT_MODE_ANGLES
66
} FlightMode_t;
67
 
68
typedef struct {
69
    uint8_t SWMajor;
70
    uint8_t SWMinor;
71
    uint8_t protoMajor;
72
    uint8_t protoMinor;
73
    uint8_t SWPatch;
74
    uint8_t hardwareErrors[5];
75
}__attribute__((packed)) VersionInfo_t;
76
 
77
extern VersionInfo_t versionInfo;
78
 
79
typedef struct {
80
  // IMU stuff:
81
  PID_t gyroPID[3];
82
 
83
  // Control
84
  /* P */uint8_t externalControl;
85
 
86
  // Output and servo
87
  /*PMM*/uint8_t output0Timing;
88
  /*PMM*/uint8_t output1Timing;
89
 
90
  /* P */uint8_t userParams[8];
91
} DynamicParams_t;
92
 
93
extern volatile DynamicParams_t dynamicParams;
94
 
95
typedef struct {
96
  uint8_t sourceIdx, targetIdx;
97
  uint8_t min, max;
98
} MMXLATION;
99
 
100
typedef struct {
2129 - 101
  uint8_t RCPolarity; // 1=positive, 0=negative. Use positive with Futaba receiver, negative with FrSky.
102
  uint8_t HWTrim;
103
  uint8_t variableOffset;
2108 - 104
  uint8_t channels[MAX_CHANNELS];
2116 - 105
} ChannelMap_t;
106
extern ChannelMap_t channelMap;
2108 - 107
 
2129 - 108
// With fixed wing, we need some way to trim the plane. This is done during a trim flight without gyros activated,
109
// and then save in a succeeding gyro calibration command.
2108 - 110
typedef struct {
2129 - 111
  int16_t trim[MAX_CHANNELS];
112
} RCTrim_t;
113
extern RCTrim_t rcTrim;
114
 
115
typedef struct {
2108 - 116
  int16_t offsets[3];
117
} sensorOffset_t;
118
 
119
typedef struct {
2139 - 120
  uint8_t reverse;
121
  int8_t minValue;
122
  int8_t maxValue;
2116 - 123
} Servo_t;
2108 - 124
 
125
#define SERVO_STABILIZATION_REVERSE 1
126
 
127
typedef struct {
128
  uint8_t bitmask;
129
  uint8_t timing;
130
} output_flash_t;
131
 
132
// values above 250 representing poti1 to poti4
133
typedef struct {
134
  // Global bitflags
135
  uint8_t bitConfig;  // see upper defines for bitcoding
136
 
137
  // Control
138
  PIDIM_t gyroPID[3];
2144 - 139
  //13
2108 - 140
 
141
  uint8_t stickIElevator;
142
  uint8_t stickIAilerons;
143
  uint8_t stickIRudder;
2144 - 144
  //16
2108 - 145
  uint8_t externalControl; // for serial Control
146
  uint8_t IFactor;
2119 - 147
  uint8_t batteryWarningVoltage;
2144 - 148
//19
2108 - 149
 
150
  // Airspeed
151
  uint8_t airspeedCorrection;
152
  uint8_t isFlyingThreshold;
2143 - 153
  uint8_t minFlashAirspeed;
154
  uint8_t maxFlashAirspeed;
2144 - 155
//23
2108 - 156
 
157
  // Servos
2132 - 158
  uint8_t servoCount;
2142 - 159
  Servo_t servos[4];
2144 - 160
  //36
2108 - 161
 
162
  // Outputs
163
  output_flash_t outputFlash[2];
2144 - 164
  //40
2108 - 165
  uint8_t outputDebugMask;
166
  uint8_t outputFlags;
167
 
168
  // User params
169
  uint8_t userParams[8];
2144 - 170
//50
2108 - 171
  // Name
172
  char name[12];
173
} ParamSet_t;
174
 
175
extern ParamSet_t staticParams;
176
 
177
// bit mask for staticParams.bitConfig
178
#define CFG_GYRO_SATURATION_PREVENTION  (1<<0)
179
#define CFG_USE_AIRSPEED_PID            (1<<1)
180
 
181
#define IMU_REVERSE_GYRO_PR             (1<<0)
182
#define IMU_REVERSE_GYRO_YAW            (1<<1)
183
#define IMU_REVERSE_ACC_XY              (1<<2)
184
#define IMU_REVERSE_ACC_Z               (1<<3)
185
 
186
#define ATMEGA644   0
187
#define ATMEGA644P  1
188
#define SYSCLK F_CPU
189
 
190
// Not really a part of configuration, but LEDs and HW s test are the same.
2135 - 191
#define RED_OFF   {PORTB &=~(1<<PORTB4);}
192
#define RED_ON    {PORTB |= (1<<PORTB4);}
193
#define RED_FLASH PORTB ^= (1<<PORTB4)
194
#define GRN_OFF   {PORTB &=~(1<<PORTB5);}
195
#define GRN_ON    {PORTB |= (1<<PORTB5);}
196
#define GRN_FLASH PORTB ^= (1<<PORTB5)
2108 - 197
 
198
// Mixer table
199
#define MIX_THROTTLE    0
200
#define MIX_PITCH   1
201
#define MIX_ROLL    2
202
#define MIX_YAW     3
203
 
204
#define VARIABLE_COUNT 8
205
 
206
extern int16_t variables[VARIABLE_COUNT]; // The "Poti"s.
207
extern uint8_t CPUType;
208
 
209
extern volatile uint16_t isFlying;
210
extern FlightMode_t currentFlightMode;
211
 
212
void IMUConfig_default(void);
213
void channelMap_default(void);
2132 - 214
void rcTrim_setZero(void);
2108 - 215
void paramSet_default(uint8_t setnumber);
216
 
217
void configuration_setFlightParameters(uint8_t newFlightMode);
218
void configuration_applyVariablesToParams(void);
219
 
220
// Called after a change in configuration parameters, as a hook for modules to take over changes.
221
void configuration_paramSetDidChange(void);
222
#endif // _CONFIGURATION_H