Subversion Repositories FlightCtrl

Rev

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

Rev Author Line No. Line
1910 - 1
#ifndef _CONFIGURATION_H
2
#define _CONFIGURATION_H
3
 
4
#include <inttypes.h>
5
#include <avr/io.h>
6
 
2124 - 7
#define MAX_CHANNELS 8
2099 - 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
 
2104 - 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
 
2102 - 61
typedef enum {
62
  FLIGHT_MODE_NONE,
63
  FLIGHT_MODE_MANUAL,
64
  FLIGHT_MODE_RATE,
65
  FLIGHT_MODE_ANGLES
66
} FlightMode_t;
67
 
1910 - 68
typedef struct {
2099 - 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;
1910 - 76
 
2099 - 77
extern VersionInfo_t versionInfo;
1910 - 78
 
2099 - 79
typedef struct {
2104 - 80
  // IMU stuff:
81
  PID_t gyroPID[3];
1910 - 82
 
2099 - 83
  // Control
84
  /* P */uint8_t externalControl;
1910 - 85
 
2099 - 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
 
1910 - 95
typedef struct {
96
  uint8_t sourceIdx, targetIdx;
97
  uint8_t min, max;
98
} MMXLATION;
99
 
100
typedef struct {
2119 - 101
  uint8_t RCPolarity; // 1=positive, 0=negative. Use positive with Futaba receiver, negative with FrSky.
2122 - 102
  uint8_t HWTrim;
2119 - 103
  uint8_t variableOffset;
2099 - 104
  uint8_t channels[MAX_CHANNELS];
2116 - 105
} ChannelMap_t;
106
extern ChannelMap_t channelMap;
1910 - 107
 
2122 - 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.
2099 - 110
typedef struct {
2122 - 111
  int16_t trim[MAX_CHANNELS];
112
} RCTrim_t;
113
extern RCTrim_t rcTrim;
114
 
115
typedef struct {
2099 - 116
  int16_t offsets[3];
117
} sensorOffset_t;
118
 
119
typedef struct {
2142 - 120
  uint8_t reverse;
121
  int8_t minValue;
122
  int8_t maxValue;
2116 - 123
} Servo_t;
2099 - 124
 
2119 - 125
#define SERVO_STABILIZATION_REVERSE 1
2099 - 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
1910 - 136
 
2099 - 137
  // Control
2104 - 138
  PIDIM_t gyroPID[3];
1910 - 139
 
2099 - 140
  uint8_t stickIElevator;
141
  uint8_t stickIAilerons;
142
  uint8_t stickIRudder;
1910 - 143
 
2129 - 144
  uint8_t externalControl; // for serial Control
145
 
2099 - 146
  uint8_t IFactor;
2132 - 147
 
2118 - 148
  uint8_t batteryWarningVoltage;
1910 - 149
 
2105 - 150
  // Airspeed
151
  uint8_t airspeedCorrection;
2109 - 152
  uint8_t isFlyingThreshold;
2105 - 153
 
2099 - 154
  // Servos
155
  uint8_t servoCount;
2142 - 156
  Servo_t servos[3];
2118 - 157
 
2099 - 158
  // Outputs
159
  output_flash_t outputFlash[2];
160
  uint8_t outputDebugMask;
161
  uint8_t outputFlags;
162
 
163
  // User params
164
  uint8_t userParams[8];
165
 
166
  // Name
167
  char name[12];
168
} ParamSet_t;
169
 
170
extern ParamSet_t staticParams;
171
 
172
// bit mask for staticParams.bitConfig
2104 - 173
#define CFG_GYRO_SATURATION_PREVENTION  (1<<0)
174
#define CFG_USE_AIRSPEED_PID            (1<<1)
1910 - 175
 
2099 - 176
#define IMU_REVERSE_GYRO_PR             (1<<0)
177
#define IMU_REVERSE_GYRO_YAW            (1<<1)
178
#define IMU_REVERSE_ACC_XY              (1<<2)
179
#define IMU_REVERSE_ACC_Z               (1<<3)
1910 - 180
 
2099 - 181
#define ATMEGA644   0
182
#define ATMEGA644P  1
1910 - 183
#define SYSCLK F_CPU
184
 
2099 - 185
// Not really a part of configuration, but LEDs and HW s test are the same.
186
#define RED_OFF   {if((boardRelease == 10) || (boardRelease == 20)) PORTB &=~(1<<PORTB0); else  PORTB |= (1<<PORTB0);}
187
#define RED_ON    {if((boardRelease == 10) || (boardRelease == 20)) PORTB |= (1<<PORTB0); else  PORTB &=~(1<<PORTB0);}
1910 - 188
#define RED_FLASH PORTB ^= (1<<PORTB0)
2099 - 189
#define GRN_OFF   {if(boardRelease  < 12) PORTB &=~(1<<PORTB1); else PORTB |= (1<<PORTB1);}
190
#define GRN_ON    {if(boardRelease  < 12) PORTB |= (1<<PORTB1); else PORTB &=~(1<<PORTB1);}
1910 - 191
#define GRN_FLASH PORTB ^= (1<<PORTB1)
192
 
193
// Mixer table
2099 - 194
#define MIX_THROTTLE    0
195
#define MIX_PITCH   1
196
#define MIX_ROLL    2
197
#define MIX_YAW     3
1910 - 198
 
2099 - 199
#define VARIABLE_COUNT 8
200
 
201
extern int16_t variables[VARIABLE_COUNT]; // The "Poti"s.
202
extern uint8_t boardRelease;
1910 - 203
extern uint8_t CPUType;
204
 
2108 - 205
extern volatile uint16_t isFlying;
2102 - 206
extern FlightMode_t currentFlightMode;
1910 - 207
 
2099 - 208
void IMUConfig_default(void);
209
void channelMap_default(void);
2122 - 210
void rcTrim_setZero(void);
2099 - 211
void paramSet_default(uint8_t setnumber);
212
 
2102 - 213
void configuration_setFlightParameters(uint8_t newFlightMode);
2099 - 214
void configuration_applyVariablesToParams(void);
215
 
216
void setCPUType(void);
217
void setBoardRelease(void);
218
 
219
// Called after a change in configuration parameters, as a hook for modules to take over changes.
220
void configuration_paramSetDidChange(void);
1910 - 221
#endif // _CONFIGURATION_H