Subversion Repositories FlightCtrl

Rev

Rev 1915 | 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)