Rev 973 | Rev 987 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 973 | Rev 983 | ||
---|---|---|---|
Line 53... | Line 53... | ||
53 | unsigned char Motor_Vorne,Motor_Hinten,Motor_Rechts,Motor_Links, Count; |
53 | unsigned char Motor_Vorne,Motor_Hinten,Motor_Rechts,Motor_Links, Count; |
54 | unsigned char MotorWert[5]; |
54 | unsigned char MotorWert[5]; |
55 | unsigned char SenderOkay = 0; |
55 | unsigned char SenderOkay = 0; |
56 | unsigned int I2CTimeout = 100; |
56 | unsigned int I2CTimeout = 100; |
57 | char MotorenEin = 0; |
57 | char MotorenEin = 0; |
- | 58 | unsigned int modell_fliegt = 0; |
|
Line 58... | Line 59... | ||
58 | 59 | ||
59 | extern unsigned long maxDistance; |
60 | extern unsigned long maxDistance; |
60 | extern signed int GPS_Nick, GPS_Roll; |
61 | extern signed int GPS_Nick, GPS_Roll; |
Line 73... | Line 74... | ||
73 | @post - |
74 | @post - |
74 | @author Michael Walter |
75 | @author Michael Walter |
75 | **************************************************************************** */ |
76 | **************************************************************************** */ |
76 | void SetNeutral(void) |
77 | void SetNeutral(void) |
77 | { |
78 | { |
- | 79 | beeptime = 2000; |
|
78 | Delay_ms(1000); |
80 | Delay_ms(1000); |
79 | if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)) // Höhenregelung aktiviert? |
81 | if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)) // Höhenregelung aktiviert? |
80 | { |
82 | { |
81 | if((AdWertAirPressure_Raw > 950) || (AdWertAirPressure_Raw < 750)) |
83 | if((AdWertAirPressure_Raw > 950) || (AdWertAirPressure_Raw < 750)) |
82 | { |
84 | { |
Line 166... | Line 168... | ||
166 | DeltaAltitude = CurrentAltitude - LastAltitude; |
168 | DeltaAltitude = CurrentAltitude - LastAltitude; |
167 | LastAltitude = CurrentAltitude; |
169 | LastAltitude = CurrentAltitude; |
168 | } |
170 | } |
169 | AirPressureCnt++; |
171 | AirPressureCnt++; |
Line -... | Line 172... | ||
- | 172 | ||
- | 173 | if(modell_fliegt < 0x250) |
|
170 | 174 | { |
|
- | 175 | //if ((GPS_Roll == 0 && GPS_Nick == 0) || (maxDistance / 10 > 10)) |
|
- | 176 | AdNeutralNick = 0.998F * AdNeutralNick + 0.002F * AdWertNick_Raw; |
|
- | 177 | AdNeutralRoll = 0.998F * AdNeutralRoll + 0.002F * AdWertRoll_Raw; |
|
- | 178 | if (abs(StickGier) < 15 || MotorenEin == 0) |
|
- | 179 | { |
|
- | 180 | AdNeutralGier = 0.998F * AdNeutralGier + 0.002F * AdWertGier_Raw; |
|
- | 181 | } |
|
- | 182 | } |
|
171 | //if ((GPS_Roll == 0 && GPS_Nick == 0) || (maxDistance / 10 > 10)) |
183 | else if(modell_fliegt < 0x2000) |
- | 184 | { |
|
172 | { |
185 | //if ((GPS_Roll == 0 && GPS_Nick == 0) || (maxDistance / 10 > 10)) |
173 | AdNeutralNick = 0.999F * AdNeutralNick + 0.001F * AdWertNick_Raw; |
186 | AdNeutralNick = 0.999F * AdNeutralNick + 0.001F * AdWertNick_Raw; |
174 | AdNeutralRoll = 0.999F * AdNeutralRoll + 0.001F * AdWertRoll_Raw; |
187 | AdNeutralRoll = 0.999F * AdNeutralRoll + 0.001F * AdWertRoll_Raw; |
175 | if (abs(StickGier) < 15 || MotorenEin == 0) |
188 | if (abs(StickGier) < 15 || MotorenEin == 0) |
176 | { |
189 | { |
177 | AdNeutralGier = 0.999F * AdNeutralGier + 0.001F * AdWertGier_Raw; |
190 | AdNeutralGier = 0.999F * AdNeutralGier + 0.001F * AdWertGier_Raw; |
178 | } |
191 | } |
- | 192 | } |
|
- | 193 | else |
|
- | 194 | { |
|
- | 195 | AdNeutralNick = 0.9995F * AdNeutralNick + 0.0005F * AdWertNick_Raw; |
|
- | 196 | AdNeutralRoll = 0.9995F * AdNeutralRoll + 0.0005F * AdWertRoll_Raw; |
|
- | 197 | if (abs(StickGier) < 15 || MotorenEin == 0) |
|
- | 198 | { |
|
- | 199 | AdNeutralGier = 0.9995F * AdNeutralGier + 0.0005F * AdWertGier_Raw; |
|
- | 200 | } |
|
Line 179... | Line 201... | ||
179 | } |
201 | } |
180 | 202 | ||
181 | #if 1 |
203 | #if 1 |
182 | DebugOut.Analog[6] = AdWertNick_Raw; |
204 | DebugOut.Analog[6] = AdWertNick_Raw; |
Line 256... | Line 278... | ||
256 | **************************************************************************** */ |
278 | **************************************************************************** */ |
257 | void RemoteControl(void) |
279 | void RemoteControl(void) |
258 | { |
280 | { |
259 | static unsigned char delay_neutral = 0; |
281 | static unsigned char delay_neutral = 0; |
260 | static unsigned char delay_einschalten = 0,delay_ausschalten = 0; |
282 | static unsigned char delay_einschalten = 0,delay_ausschalten = 0; |
261 | static unsigned int modell_fliegt = 0; |
- | |
Line 262... | Line 283... | ||
262 | 283 | ||
263 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
284 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
264 | // Gaswert ermitteln |
285 | // Gaswert ermitteln |
265 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
286 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |