Rev 2129 | 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 |
||
2125 | - | 44 | int8_t gyroCalibrationTweak[3]; |
2104 | - | 45 | } IMUConfig_t; |
46 | |||
47 | extern IMUConfig_t IMUConfig; |
||
48 | |||
49 | typedef struct { |
||
50 | uint8_t P; |
||
51 | uint8_t I; |
||
52 | uint8_t D; |
||
53 | } PID_t; |
||
54 | |||
55 | typedef struct { |
||
56 | uint8_t P; |
||
57 | uint8_t I; |
||
58 | uint8_t D; |
||
59 | uint8_t iMax; |
||
60 | } PIDIM_t; |
||
61 | |||
2102 | - | 62 | typedef enum { |
63 | FLIGHT_MODE_NONE, |
||
64 | FLIGHT_MODE_MANUAL, |
||
65 | FLIGHT_MODE_RATE, |
||
66 | FLIGHT_MODE_ANGLES |
||
67 | } FlightMode_t; |
||
68 | |||
69 | #define CONTROL_SERVO_REVERSE_ELEVATOR 1 |
||
70 | #define CONTROL_SERVO_REVERSE_AILERONS 2 |
||
71 | #define CONTROL_SERVO_REVERSE_RUDDER 4 |
||
72 | |||
1910 | - | 73 | typedef struct { |
2099 | - | 74 | uint8_t SWMajor; |
75 | uint8_t SWMinor; |
||
76 | uint8_t protoMajor; |
||
77 | uint8_t protoMinor; |
||
78 | uint8_t SWPatch; |
||
79 | uint8_t hardwareErrors[5]; |
||
80 | }__attribute__((packed)) VersionInfo_t; |
||
1910 | - | 81 | |
2099 | - | 82 | extern VersionInfo_t versionInfo; |
1910 | - | 83 | |
2099 | - | 84 | typedef struct { |
2104 | - | 85 | // IMU stuff: |
86 | PID_t gyroPID[3]; |
||
1910 | - | 87 | |
2099 | - | 88 | // Control |
89 | /* P */uint8_t externalControl; |
||
1910 | - | 90 | |
2099 | - | 91 | // Output and servo |
92 | /*PMM*/uint8_t output0Timing; |
||
93 | /*PMM*/uint8_t output1Timing; |
||
94 | |||
2119 | - | 95 | uint8_t gimbalServoManualControl[2]; |
2099 | - | 96 | |
97 | /* P */uint8_t userParams[8]; |
||
98 | } DynamicParams_t; |
||
99 | |||
100 | extern volatile DynamicParams_t dynamicParams; |
||
101 | |||
1910 | - | 102 | typedef struct { |
103 | uint8_t sourceIdx, targetIdx; |
||
104 | uint8_t min, max; |
||
105 | } MMXLATION; |
||
106 | |||
2099 | - | 107 | /* |
1910 | - | 108 | typedef struct { |
109 | uint8_t sourceIdx, targetIdx; |
||
110 | } XLATION; |
||
2099 | - | 111 | */ |
1910 | - | 112 | |
113 | typedef struct { |
||
2119 | - | 114 | uint8_t RCPolarity; // 1=positive, 0=negative. Use positive with Futaba receiver, negative with FrSky. |
2122 | - | 115 | uint8_t HWTrim; |
2119 | - | 116 | uint8_t variableOffset; |
2099 | - | 117 | uint8_t channels[MAX_CHANNELS]; |
2116 | - | 118 | } ChannelMap_t; |
119 | extern ChannelMap_t channelMap; |
||
1910 | - | 120 | |
2122 | - | 121 | // With fixed wing, we need some way to trim the plane. This is done during a trim flight without gyros activated, |
122 | // and then save in a succeeding gyro calibration command. |
||
2099 | - | 123 | typedef struct { |
2122 | - | 124 | int16_t trim[MAX_CHANNELS]; |
125 | } RCTrim_t; |
||
126 | extern RCTrim_t rcTrim; |
||
127 | |||
128 | typedef struct { |
||
2099 | - | 129 | int16_t offsets[3]; |
130 | } sensorOffset_t; |
||
131 | |||
132 | typedef struct { |
||
133 | uint8_t manualControl; |
||
134 | uint8_t stabilizationFactor; |
||
135 | uint8_t minValue; |
||
136 | uint8_t maxValue; |
||
137 | uint8_t flags; |
||
2116 | - | 138 | } Servo_t; |
2099 | - | 139 | |
2119 | - | 140 | #define SERVO_STABILIZATION_REVERSE 1 |
2099 | - | 141 | |
142 | typedef struct { |
||
143 | uint8_t bitmask; |
||
144 | uint8_t timing; |
||
145 | } output_flash_t; |
||
146 | |||
147 | // values above 250 representing poti1 to poti4 |
||
148 | typedef struct { |
||
149 | // Global bitflags |
||
150 | uint8_t bitConfig; // see upper defines for bitcoding |
||
1910 | - | 151 | |
2099 | - | 152 | // Control |
2104 | - | 153 | PIDIM_t gyroPID[3]; |
1910 | - | 154 | |
2099 | - | 155 | uint8_t stickIElevator; |
156 | uint8_t stickIAilerons; |
||
157 | uint8_t stickIRudder; |
||
1910 | - | 158 | |
2129 | - | 159 | uint8_t externalControl; // for serial Control |
160 | |||
2099 | - | 161 | uint8_t IFactor; |
2132 | - | 162 | |
2118 | - | 163 | uint8_t batteryWarningVoltage; |
1910 | - | 164 | |
2105 | - | 165 | // Airspeed |
166 | uint8_t airspeedCorrection; |
||
2109 | - | 167 | uint8_t isFlyingThreshold; |
2105 | - | 168 | |
2099 | - | 169 | // Servos |
170 | uint8_t servoCount; |
||
2119 | - | 171 | uint8_t servosReverse; |
2118 | - | 172 | |
2116 | - | 173 | uint8_t controlServoMinValue; |
174 | uint8_t controlServoMaxValue; |
||
175 | |||
2118 | - | 176 | uint8_t gimbalServoMaxManualSpeed; |
177 | Servo_t gimbalServoConfigurations[2]; // [PITCH, ROLL] |
||
1910 | - | 178 | |
2099 | - | 179 | // Outputs |
180 | output_flash_t outputFlash[2]; |
||
181 | uint8_t outputDebugMask; |
||
182 | uint8_t outputFlags; |
||
183 | |||
184 | // User params |
||
185 | uint8_t userParams[8]; |
||
186 | |||
187 | // Name |
||
188 | char name[12]; |
||
189 | } ParamSet_t; |
||
190 | |||
191 | extern ParamSet_t staticParams; |
||
192 | |||
193 | // bit mask for staticParams.bitConfig |
||
2104 | - | 194 | #define CFG_GYRO_SATURATION_PREVENTION (1<<0) |
195 | #define CFG_USE_AIRSPEED_PID (1<<1) |
||
1910 | - | 196 | |
2099 | - | 197 | #define IMU_REVERSE_GYRO_PR (1<<0) |
198 | #define IMU_REVERSE_GYRO_YAW (1<<1) |
||
199 | #define IMU_REVERSE_ACC_XY (1<<2) |
||
200 | #define IMU_REVERSE_ACC_Z (1<<3) |
||
1910 | - | 201 | |
2099 | - | 202 | #define ATMEGA644 0 |
203 | #define ATMEGA644P 1 |
||
1910 | - | 204 | #define SYSCLK F_CPU |
205 | |||
2099 | - | 206 | // Not really a part of configuration, but LEDs and HW s test are the same. |
207 | #define RED_OFF {if((boardRelease == 10) || (boardRelease == 20)) PORTB &=~(1<<PORTB0); else PORTB |= (1<<PORTB0);} |
||
208 | #define RED_ON {if((boardRelease == 10) || (boardRelease == 20)) PORTB |= (1<<PORTB0); else PORTB &=~(1<<PORTB0);} |
||
1910 | - | 209 | #define RED_FLASH PORTB ^= (1<<PORTB0) |
2099 | - | 210 | #define GRN_OFF {if(boardRelease < 12) PORTB &=~(1<<PORTB1); else PORTB |= (1<<PORTB1);} |
211 | #define GRN_ON {if(boardRelease < 12) PORTB |= (1<<PORTB1); else PORTB &=~(1<<PORTB1);} |
||
1910 | - | 212 | #define GRN_FLASH PORTB ^= (1<<PORTB1) |
213 | |||
214 | // Mixer table |
||
2099 | - | 215 | #define MIX_THROTTLE 0 |
216 | #define MIX_PITCH 1 |
||
217 | #define MIX_ROLL 2 |
||
218 | #define MIX_YAW 3 |
||
1910 | - | 219 | |
2099 | - | 220 | #define VARIABLE_COUNT 8 |
221 | |||
222 | extern int16_t variables[VARIABLE_COUNT]; // The "Poti"s. |
||
223 | extern uint8_t boardRelease; |
||
1910 | - | 224 | extern uint8_t CPUType; |
225 | |||
2108 | - | 226 | extern volatile uint16_t isFlying; |
2102 | - | 227 | extern FlightMode_t currentFlightMode; |
1910 | - | 228 | |
2099 | - | 229 | void IMUConfig_default(void); |
230 | void channelMap_default(void); |
||
2122 | - | 231 | void rcTrim_setZero(void); |
2099 | - | 232 | void paramSet_default(uint8_t setnumber); |
233 | |||
2102 | - | 234 | void configuration_setFlightParameters(uint8_t newFlightMode); |
2099 | - | 235 | void configuration_applyVariablesToParams(void); |
236 | |||
237 | void setCPUType(void); |
||
238 | void setBoardRelease(void); |
||
239 | |||
240 | // Called after a change in configuration parameters, as a hook for modules to take over changes. |
||
241 | void configuration_paramSetDidChange(void); |
||
1910 | - | 242 | #endif // _CONFIGURATION_H |