Rev 1915 | Rev 1917 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1915 | Rev 1916 | ||
---|---|---|---|
Line 249... | Line 249... | ||
249 | 249 | ||
250 | Debug(ANSI_CLEAR "FC-Start!\n\rFlugzeit: %d min", FlugMinutenGesamt); // Note: this won't waste flash memory, if #DEBUG is not active |
250 | Debug(ANSI_CLEAR "FC-Start!\n\rFlugzeit: %d min", FlugMinutenGesamt); // Note: this won't waste flash memory, if #DEBUG is not active |
251 | DebugOut.Status[0] = 0x01 | 0x02; |
251 | DebugOut.Status[0] = 0x01 | 0x02; |
252 | JetiBeep = 0; |
252 | JetiBeep = 0; |
- | 253 | if(EE_Parameter.ExtraConfig & CFG_NO_RCOFF_BEEPING) DisableRcOffBeeping = 1; |
|
253 | if(EE_Parameter.ExtraConfig & CFG_NO_RCOFF_BEEPING) DisableRcOffBeeping = 1; |
254 | |
254 | while (1) |
255 | while (1) |
255 | { |
- | |
256 | 256 | { |
|
Line 257... | Line -... | ||
257 | if (JetiUpdateModeActive) while (1); |
- | |
258 | - | ||
259 | - | ||
260 | if(CheckDelay(timerPolling)) |
- | |
261 | { |
- | |
262 | timerPolling = SetDelay(1); |
- | |
263 | LIBFC_Polling(); |
257 | if (JetiUpdateModeActive) while (1); |
264 | } |
258 | |
265 | if(UpdateMotor && AdReady) // ReglerIntervall |
- | |
266 | { |
259 | if(UpdateMotor && AdReady) // ReglerIntervall |
267 | 260 | { |
|
268 | UpdateMotor=0; |
261 | UpdateMotor=0; |
269 | if(WinkelOut.CalcState) CalMk3Mag(); |
262 | if(WinkelOut.CalcState) CalMk3Mag(); |
270 | else MotorRegler(); |
263 | else MotorRegler(); |
Line 303... | Line 296... | ||
303 | if(!beeptime) |
296 | if(!beeptime) |
304 | { |
297 | { |
305 | VersionInfo.HardwareError[1] &= ~FC_ERROR1_I2C; |
298 | VersionInfo.HardwareError[1] &= ~FC_ERROR1_I2C; |
306 | } |
299 | } |
307 | } |
300 | } |
- | 301 | LIBFC_Polling(); |
|
- | 302 | ||
308 | if(!UpdateMotor) |
303 | if(!UpdateMotor) |
309 | { |
304 | { |
310 | if(CalculateServoSignals) CalculateServo(); |
305 | if(CalculateServoSignals) CalculateServo(); |
311 | DatenUebertragung(); |
306 | DatenUebertragung(); |
312 | BearbeiteRxDaten(); |
307 | BearbeiteRxDaten(); |
Line 362... | Line 357... | ||
362 | } |
357 | } |
363 | } |
358 | } |
364 | GPS_Nick = 0; |
359 | GPS_Nick = 0; |
365 | GPS_Roll = 0; |
360 | GPS_Roll = 0; |
366 | GPS_AidMode = 0; |
361 | GPS_AidMode = 0; |
- | 362 | GPSInfo.Flags = 0; |
|
367 | //if(!beeptime) |
363 | //if(!beeptime) |
368 | FromNaviCtrl.CompassValue = -1; |
364 | FromNaviCtrl.CompassValue = -1; |
369 | NaviDataOkay = 0; |
365 | NaviDataOkay = 0; |
370 | } |
366 | } |
371 | if(UBat < BattLowVoltageWarning) |
367 | if(UBat < BattLowVoltageWarning) |