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