Subversion Repositories FlightCtrl

Rev

Rev 2095 | Rev 2117 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1612 dongfang 1
#ifndef _CONFIGURATION_H
2
#define _CONFIGURATION_H
3
 
4
#include <inttypes.h>
5
#include <avr/io.h>
6
 
1960 - 7
#define MAX_CHANNELS 10
8
#define MAX_MOTORS 12
9
 
2018 - 10
// bitmask for VersionInfo_t.HardwareError[0]
11
#define FC_ERROR0_GYRO_PITCH    0x01
12
#define FC_ERROR0_GYRO_ROLL     0x02
13
#define FC_ERROR0_GYRO_YAW              0x04
14
#define FC_ERROR0_ACC_X                 0x08
15
#define FC_ERROR0_ACC_Y                 0x10
16
#define FC_ERROR0_ACC_Z                 0x20
17
#define FC_ERROR0_PRESSURE              0x40
18
#define FC_ERROR1_RES0                  0x80
19
// bitmask for VersionInfo_t.HardwareError[1]
20
#define FC_ERROR1_I2C                   0x01
21
#define FC_ERROR1_BL_MISSING    0x02
22
#define FC_ERROR1_SPI_RX                0x04
23
#define FC_ERROR1_PPM                   0x08
24
#define FC_ERROR1_MIXER                 0x10
25
#define FC_ERROR1_RES1                  0x20
26
#define FC_ERROR1_RES2                  0x40
27
#define FC_ERROR1_RES3                  0x80
28
 
1612 dongfang 29
typedef struct {
2018 - 30
        uint8_t SWMajor;
31
        uint8_t SWMinor;
32
        uint8_t protoMajor;
33
        uint8_t protoMinor;
34
        uint8_t SWPatch;
35
        uint8_t hardwareErrors[5];
36
}__attribute__((packed)) VersionInfo_t;
37
 
38
extern VersionInfo_t versionInfo;
39
 
40
typedef struct {
1960 - 41
  /*PMM*/uint8_t gyroP;
2032 - 42
  /* P */uint8_t gyroI;
1960 - 43
  /* P */uint8_t gyroD;
2052 - 44
  /* P */uint8_t compassControlHeading;
1960 - 45
 
46
  // Control
47
  /* P */uint8_t externalControl;
48
  /* P */uint8_t dynamicStability;
49
 
50
  // Height control
51
  /*PMM*/uint8_t heightP;
2032 - 52
  /* P */uint8_t heightI;
1960 - 53
  /*PMM*/uint8_t heightD;
54
  /* P */uint8_t heightSetting;
55
 
56
  uint8_t attitudeControl;
57
 
2039 - 58
  // Output and servo
1960 - 59
  /*PMM*/uint8_t output0Timing;
60
  /*PMM*/uint8_t output1Timing;
61
 
62
  uint8_t servoManualControl[2];
2039 - 63
 
64
  // Correction
2032 - 65
  uint8_t levelCorrection[2];
1960 - 66
 
2039 - 67
  // Simple direct navigation
2045 - 68
  uint8_t naviMode;
2039 - 69
 
2032 - 70
  /* P */uint8_t userParams[8];
2059 - 71
} DynamicParams_t;
1960 - 72
 
2059 - 73
extern volatile DynamicParams_t dynamicParams;
1612 dongfang 74
 
1775 - 75
typedef struct {
1864 - 76
  uint8_t sourceIdx, targetIdx;
77
  uint8_t min, max;
1775 - 78
} MMXLATION;
1612 dongfang 79
 
2059 - 80
/*
1775 - 81
typedef struct {
1864 - 82
  uint8_t sourceIdx, targetIdx;
1775 - 83
} XLATION;
2059 - 84
*/
1775 - 85
 
1960 - 86
typedef struct {
87
  uint8_t channels[MAX_CHANNELS];
88
} channelMap_t;
89
extern channelMap_t channelMap;
90
 
91
typedef struct {
2017 - 92
  char name[12];
1960 - 93
  int8_t motor[MAX_MOTORS][4];
94
}__attribute__((packed)) mixerMatrix_t;
95
extern mixerMatrix_t mixerMatrix;
96
 
97
typedef struct {
1965 - 98
  int16_t offsets[3];
99
} sensorOffset_t;
100
 
101
typedef struct {
1960 - 102
  uint8_t manualControl;
1980 - 103
  uint8_t stabilizationFactor;
1960 - 104
  uint8_t minValue;
105
  uint8_t maxValue;
106
  uint8_t flags;
107
} servo_t;
108
 
1980 - 109
#define SERVO_STABILIZATION_REVERSE 1
1977 - 110
 
1960 - 111
typedef struct {
112
  uint8_t bitmask;
113
  uint8_t timing;
114
} output_flash_t;
115
 
1612 dongfang 116
typedef struct {
2015 - 117
  uint8_t gyroQuadrant;
118
  uint8_t accQuadrant;
119
  uint8_t imuReversedFlags;
2113 - 120
 
1960 - 121
  uint8_t gyroPIDFilterConstant;
2095 - 122
  uint8_t gyroDWindowLength;
1960 - 123
  uint8_t gyroDFilterConstant;
124
  uint8_t accFilterConstant;
125
 
2018 - 126
  uint8_t zerothOrderCorrection;
2089 - 127
  uint8_t rateTolerance;
2092 - 128
 
2095 - 129
  uint8_t gyroActivityDamping;
1960 - 130
  uint8_t driftCompDivider; // 1/k  (Koppel_ACC_Wirkung)
131
  uint8_t driftCompLimit;   // limit for gyrodrift compensation
2092 - 132
} IMUConfig_t;
1960 - 133
 
2092 - 134
extern IMUConfig_t IMUConfig;
135
 
136
// values above 250 representing poti1 to poti4
137
typedef struct {
138
  // Global bitflags
139
  uint8_t bitConfig;  // see upper defines for bitcoding
140
 
2051 - 141
  // uint8_t axisCoupling1; // Value: 0-250  Faktor, mit dem Yaw die Achsen Roll und Nick koppelt (NickRollMitkopplung)
142
  // uint8_t axisCoupling2; // Value: 0-250  Faktor, mit dem Nick und Roll verkoppelt werden
143
  // uint8_t axisCouplingYawCorrection;// Value: 0-250  Faktor, mit dem Nick und Roll verkoppelt werden
1960 - 144
 
2032 - 145
  uint8_t levelCorrection[2];
146
 
147
  // Control
148
  uint8_t gyroP;
149
  uint8_t gyroI;
150
  uint8_t gyroD;
151
 
152
  uint8_t attitudeControl;
2051 - 153
 
2032 - 154
  uint8_t stickP;
155
  uint8_t stickD;
156
  uint8_t stickYawP;
157
  uint8_t stickThrottleD;
2051 - 158
 
2032 - 159
  uint8_t minThrottle;
160
  uint8_t maxThrottle;
2051 - 161
 
2032 - 162
  uint8_t externalControl; // for serial Control
163
  uint8_t motorSmoothing;
1960 - 164
  uint8_t dynamicStability; // PID limit for Attitude controller
2051 - 165
 
2018 - 166
  uint8_t IFactor;
1960 - 167
  uint8_t yawIFactor;
2051 - 168
 
2052 - 169
  uint8_t compassMode;      // bitflag thing.
2051 - 170
  uint8_t compassYawCorrection;
2052 - 171
  uint8_t compassBendingReturnSpeed;
172
  uint8_t compassP;
2051 - 173
 
2032 - 174
  uint8_t batteryVoltageWarning;
175
  uint8_t emergencyThrottle;
176
  uint8_t emergencyFlightDuration;
1612 dongfang 177
 
2032 - 178
  // Height Control
2035 - 179
  uint8_t airpressureFilterConstant;
180
  uint8_t airpressureWindowLength; // 0 means: Use filter.
2073 - 181
  uint8_t airpressureDWindowLength; // values 1..5 are legal.
2032 - 182
  uint8_t airpressureAccZCorrection;
2074 - 183
 
2032 - 184
  uint8_t heightP;
185
  uint8_t heightI;
186
  uint8_t heightD;
2074 - 187
 
2032 - 188
  uint8_t heightSetting;
2073 - 189
  uint8_t heightControlMaxIntegralIn;
190
  uint8_t heightControlMaxIntegralOut;
2032 - 191
  uint8_t heightControlMaxThrottleChange;
192
 
2074 - 193
  uint8_t heightControlTestOscPeriod;
194
  uint8_t heightControlTestOscAmplitude;
195
 
1960 - 196
  // Servos
1980 - 197
  uint8_t servoCount;
198
  uint8_t servoManualMaxSpeed;
1960 - 199
  servo_t servoConfigurations[2]; // [PITCH, ROLL]
1612 dongfang 200
 
1960 - 201
  // Outputs
202
  output_flash_t outputFlash[2];
203
  uint8_t outputDebugMask;
1986 - 204
  uint8_t outputFlags;
1612 dongfang 205
 
2039 - 206
 // Shared for both modes of navigation
2045 - 207
  uint8_t naviMode;
2039 - 208
  uint8_t naviStickThreshold;
2047 - 209
  uint8_t naviStickLimit;
2039 - 210
  uint8_t GPSMininumSatellites;
211
  uint8_t naviP;
212
  uint8_t naviI;
213
  uint8_t naviD;
214
 
2086 - 215
  uint8_t naviTestOscPeriod;
216
  uint8_t naviTestOscAmplitude;
217
 
1960 - 218
  // User params
2018 - 219
  uint8_t userParams[8];
1612 dongfang 220
 
1960 - 221
  // Name
2017 - 222
  char name[12];
2039 - 223
} ParamSet_t;
1960 - 224
 
2039 - 225
extern ParamSet_t staticParams;
226
 
1612 dongfang 227
// MKFlags
228
#define MKFLAG_MOTOR_RUN        (1<<0)
2055 - 229
//#define MKFLAG_FLY            (1<<1)
1612 dongfang 230
#define MKFLAG_CALIBRATE        (1<<2)
231
#define MKFLAG_START            (1<<3)
1960 - 232
#define MKFLAG_EMERGENCY_FLIGHT (1<<4)
2035 - 233
#define MKFLAG_LOWBAT           (1<<5)
1612 dongfang 234
#define MKFLAG_RESERVE2         (1<<6)
235
#define MKFLAG_RESERVE3         (1<<7)
236
 
1960 - 237
// bit mask for staticParams.bitConfig
1980 - 238
#define CFG_SIMPLE_HEIGHT_CONTROL               (1<<0)
1961 - 239
#define CFG_SIMPLE_HC_HOLD_SWITCH       (1<<1)
1980 - 240
#define CFG_HEADING_HOLD                        (1<<2)
2052 - 241
#define CFG_COMPASS_ENABLED             (1<<3)
242
#define CFG_UNUSED                              (1<<4)
2088 - 243
#define CFG_NAVI_ENABLED                        (1<<5)
2058 - 244
#define CFG_AXIS_COUPLING_ENABLED       (1<<6)
1960 - 245
#define CFG_GYRO_SATURATION_PREVENTION  (1<<7)
1612 dongfang 246
 
2020 - 247
#define IMU_REVERSE_GYRO_PR                             (1<<0)
248
#define IMU_REVERSE_GYRO_YAW                    (1<<1)
249
#define IMU_REVERSE_ACC_XY                              (1<<2)
250
#define IMU_REVERSE_ACC_Z                               (1<<3)
251
 
1612 dongfang 252
#define ATMEGA644       0
253
#define ATMEGA644P      1
254
#define SYSCLK F_CPU
255
 
2033 - 256
// Not really a part of configuration, but LEDs and HW s test are the same.
1960 - 257
#define RED_OFF   {if((boardRelease == 10) || (boardRelease == 20)) PORTB &=~(1<<PORTB0); else  PORTB |= (1<<PORTB0);}
258
#define RED_ON    {if((boardRelease == 10) || (boardRelease == 20)) PORTB |= (1<<PORTB0); else  PORTB &=~(1<<PORTB0);}
1612 dongfang 259
#define RED_FLASH PORTB ^= (1<<PORTB0)
1960 - 260
#define GRN_OFF   {if(boardRelease  < 12) PORTB &=~(1<<PORTB1); else PORTB |= (1<<PORTB1);}
261
#define GRN_ON    {if(boardRelease  < 12) PORTB |= (1<<PORTB1); else PORTB &=~(1<<PORTB1);}
1612 dongfang 262
#define GRN_FLASH PORTB ^= (1<<PORTB1)
263
 
264
// Mixer table
265
#define MIX_THROTTLE    0
266
#define MIX_PITCH       1
267
#define MIX_ROLL        2
268
#define MIX_YAW         3
269
 
1961 - 270
#define VARIABLE_COUNT 8
271
 
1612 dongfang 272
extern volatile uint8_t MKFlags;
1960 - 273
extern uint8_t requiredMotors;
1961 - 274
extern int16_t variables[VARIABLE_COUNT]; // The "Poti"s.
1960 - 275
extern uint8_t boardRelease;
1612 dongfang 276
extern uint8_t CPUType;
277
 
1963 - 278
extern volatile uint8_t MKFlags;
279
extern uint16_t isFlying;
280
 
2092 - 281
void IMUConfig_default(void);
1960 - 282
void channelMap_default(void);
283
void paramSet_default(uint8_t setnumber);
284
void mixerMatrix_default(void);
285
 
2059 - 286
void configuration_setNormalFlightParameters(void);
287
void configuration_setFailsafeFlightParameters(void);
1612 dongfang 288
void configuration_applyVariablesToParams(void);
2059 - 289
 
2088 - 290
void setCPUType(void);
291
void setBoardRelease(void);
1612 dongfang 292
 
2059 - 293
// Called after a change in configuration parameters, as a hook for modules to take over changes.
294
void configuration_paramSetDidChange(void);
1612 dongfang 295
#endif // _CONFIGURATION_H