Subversion Repositories FlightCtrl

Rev

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

Rev 1936 Rev 1937
Line 263... Line 263...
263
                        UpdateMotor=0;    
263
                        UpdateMotor=0;    
264
            if(WinkelOut.CalcState) CalMk3Mag();
264
            if(WinkelOut.CalcState) CalMk3Mag();
265
            else  MotorRegler();
265
            else  MotorRegler();
266
                        SendMotorData();
266
                        SendMotorData();
267
            ROT_OFF;
267
            ROT_OFF;
268
            if(SenderOkay)  { SenderOkay--; VersionInfo.HardwareError[1] &= ~FC_ERROR1_PPM; }
268
            if(SenderOkay)  { SenderOkay--; /*VersionInfo.HardwareError[1] &= ~FC_ERROR1_PPM;*/ }
269
                        else
269
                        else
270
                        {
270
                        {
271
                                TIMSK1 |= _BV(ICIE1); // enable PPM-Input
271
                                TIMSK1 |= _BV(ICIE1); // enable PPM-Input
272
                                PPM_in[0] = 0; // set RSSI to zero on data timeout
272
                                PPM_in[0] = 0; // set RSSI to zero on data timeout
273
                                VersionInfo.HardwareError[1] |= FC_ERROR1_PPM;
273
                                VersionInfo.HardwareError[1] |= FC_ERROR1_PPM;
Line 293... Line 293...
293
                   }
293
                   }
294
                }
294
                }
295
            else
295
            else
296
                {
296
                {
297
                 ROT_OFF;
297
                 ROT_OFF;
298
                                 if(!beeptime)
298
/*                               if(!beeptime)
299
                                  {
299
                                  {
300
                                   VersionInfo.HardwareError[1] &= ~FC_ERROR1_I2C;
300
                                   VersionInfo.HardwareError[1] &= ~FC_ERROR1_I2C;
301
                                  }
301
                                  }
302
                }
302
*/                }
303
                  LIBFC_Polling();
303
                  LIBFC_Polling();
Line 304... Line 304...
304
 
304
 
305
          if(!UpdateMotor)
305
          if(!UpdateMotor)
306
                   {
306
                   {
Line 321... Line 321...
321
                                 }
321
                                 }
322
                                 else
322
                                 else
323
                                 {
323
                                 {
324
                                   if(!beeptime)
324
                                   if(!beeptime)
325
                                    {
325
                                    {
326
                                         VersionInfo.HardwareError[1] &= ~FC_ERROR1_BL_MISSING;
326
//                                       VersionInfo.HardwareError[1] &= ~FC_ERROR1_BL_MISSING;
327
                                     if(I2CTimeout > 6) DebugOut.Status[1] &= ~0x02; // BL-Error-Status
327
                                     if(I2CTimeout > 6) DebugOut.Status[1] &= ~0x02; // BL-Error-Status
328
                                        }
328
                                        }
329
                                 }
329
                                 }
330
                            if(I2CTimeout > 6) if(!beeptime) VersionInfo.HardwareError[1] &= ~FC_ERROR1_I2C;
330
//                          if(I2CTimeout > 6) if(!beeptime) VersionInfo.HardwareError[1] &= ~FC_ERROR1_I2C;
331
                                if(SenderOkay && DisableRcOffBeeping) { DisableRcOffBeeping = 0; beeptime = 5000;};
331
                                if(SenderOkay && DisableRcOffBeeping) { DisableRcOffBeeping = 0; beeptime = 5000;};
332
                                if(PcZugriff) PcZugriff--;
332
                                if(PcZugriff) PcZugriff--;
333
                                else
333
                                else
334
                                {
334
                                {
335
                                        ExternControl.Config = 0;
335
                                        ExternControl.Config = 0;