Subversion Repositories FlightCtrl

Rev

Rev 1942 | Rev 1945 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1942 Rev 1944
Line 293... Line 293...
293
                   }
293
                   }
294
                }
294
                }
295
            else
295
            else
296
                {
296
                {
297
                 ROT_OFF;
297
                 ROT_OFF;
298
/*                               if(!beeptime)
-
 
299
                                  {
-
 
300
                                   VersionInfo.HardwareError[1] &= ~FC_ERROR1_I2C;
-
 
301
                                  }
-
 
302
*/                }
298
                }
303
                  LIBFC_Polling();
299
                  LIBFC_Polling();
Line 304... Line 300...
304
 
300
 
305
          if(!UpdateMotor)
301
          if(!UpdateMotor)
306
                   {
302
                   {
Line 321... Line 317...
321
                                 }
317
                                 }
322
                                 else
318
                                 else
323
                                 {
319
                                 {
324
                                   if(!beeptime)
320
                                   if(!beeptime)
325
                                    {
321
                                    {
326
//                                       VersionInfo.HardwareError[1] &= ~FC_ERROR1_BL_MISSING;
-
 
327
                                     if(I2CTimeout > 6) DebugOut.Status[1] &= ~0x02; // BL-Error-Status
322
                                     if(I2CTimeout > 6) DebugOut.Status[1] &= ~0x02; // BL-Error-Status
328
                                        }
323
                                        }
329
                                 }
324
                                 }
330
//                          if(I2CTimeout > 6) if(!beeptime) VersionInfo.HardwareError[1] &= ~FC_ERROR1_I2C;
-
 
331
                                if(SenderOkay && DisableRcOffBeeping) { DisableRcOffBeeping = 0; beeptime = 5000;};
325
                                if(SenderOkay && DisableRcOffBeeping) { DisableRcOffBeeping = 0; beeptime = 5000;};
332
                                if(PcZugriff) PcZugriff--;
326
                                if(PcZugriff) PcZugriff--;
333
                                else
327
                                else
334
                                {
328
                                {
335
                                        ExternControl.Config = 0;
329
                                        ExternControl.Config = 0;
Line 367... Line 361...
367
                                        GPS_Roll = 0;
361
                                        GPS_Roll = 0;
368
                                        GPS_AidMode = 0;
362
                                        GPS_AidMode = 0;
369
                                        GPSInfo.Flags = 0;
363
                                        GPSInfo.Flags = 0;
370
                                        FromNaviCtrl.AccErrorN = 0;
364
                                        FromNaviCtrl.AccErrorN = 0;
371
                                        FromNaviCtrl.AccErrorR = 0;
365
                                        FromNaviCtrl.AccErrorR = 0;
372
                                        //if(!beeptime)
-
 
373
                    FromNaviCtrl.CompassValue = -1;
366
                    FromNaviCtrl.CompassValue = -1;
374
                    NaviDataOkay = 0;
367
                    NaviDataOkay = 0;
375
                                }
368
                                }
376
                           if(UBat < BattLowVoltageWarning)
369
                           if(UBat < BattLowVoltageWarning)
377
                                {
370
                                {
Line 384... Line 377...
384
                                }
377
                                }
385
                                else if(!beeptime) FC_StatusFlags &= ~FC_STATUS_LOWBAT;
378
                                else if(!beeptime) FC_StatusFlags &= ~FC_STATUS_LOWBAT;
Line 386... Line 379...
386
 
379
 
387
                                SPI_StartTransmitPacket();
380
                                SPI_StartTransmitPacket();
388
                                SendSPI = 4;
381
                                SendSPI = 4;
389
                                if(!MotorenEin) timer2 = 1450; // 0,5 Minuten aufrunden
382
                                if(!(FC_StatusFlags & FC_STATUS_FLY)) timer2 = 1450; // 0,5 Minuten aufrunden
390
                                else
383
                                else
391
                if(++second == 49)
384
                if(++second == 49)
392
                                 {
385
                                 {
393
                                   second = 0;
386
                                   second = 0;
Line 411... Line 404...
411
          }
404
          }
412
     if(!SendSPI) { SPI_TransmitByte(); }
405
     if(!SendSPI) { SPI_TransmitByte(); }
413
    }
406
    }
414
 return (1);
407
 return (1);
415
}
408
}
416
 
-
 
-
 
409
//DebugOut.Analog[16]