Subversion Repositories NaviCtrl

Rev

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

Rev 850 Rev 862
Line 539... Line 539...
539
                 {
539
                 {
540
                  if(--UART1_BaudrateFallbackTimeout == 0) UART1_Configure(Uart1Baudrate);
540
                  if(--UART1_BaudrateFallbackTimeout == 0) UART1_Configure(Uart1Baudrate);
541
                 }
541
                 }
Line 542... Line 542...
542
 
542
 
-
 
543
                if(CanbusTimeOut >= 2) CanbusTimeOut--;
-
 
544
                if(LaserCtrlTimeout)
543
                if(CanbusTimeOut >= 2) CanbusTimeOut--;
545
                 {
-
 
546
                  LaserCtrlTimeout--;
-
 
547
                  if((LaserCtrlTimeout == 27000) || (LaserCtrlTimeout == 11000) || (LaserCtrlTimeout == 21000))         I2CBus_StateReset(I2C0);
544
                if(LaserCtrlTimeout) LaserCtrlTimeout--;
548
                 }
545
                 else
549
                 else
546
                 {
550
                 {
547
                   FromLaserCtrl.Distance = 0;
551
                   FromLaserCtrl.Distance = 0;
548
                   FromLaserCtrl.LaserStatus = 0;
552
                   FromLaserCtrl.LaserStatus = 0;
Line -... Line 553...
-
 
553
                 };
-
 
554
 
549
                 };
555
                if(GimbalCtrlTimeout)
-
 
556
                 {
-
 
557
                  GimbalCtrlTimeout--;
550
 
558
                  if((GimbalCtrlTimeout == 28000) || (GimbalCtrlTimeout == 10000) || (GimbalCtrlTimeout == 20000))      I2CBus_StateReset(I2C0);
551
                if(GimbalCtrlTimeout) GimbalCtrlTimeout--;
559
                 }
552
                else
560
                else
553
                 {
561
                 {
554
                   FromGimbalCtrl.Nick = -1;
562
                   FromGimbalCtrl.Nick = -1;
Line 559... Line 567...
559
 
567
 
560
                if(CamCtrlTimeout)
568
                if(CamCtrlTimeout)
561
                 {
569
                 {
562
                  if(--CamCtrlTimeout == 1) CamCtrlCharacter = '?';
570
                  if(--CamCtrlTimeout == 1) CamCtrlCharacter = '?';
-
 
571
                  else if(CamCtrlTimeout == 10000) CamCtrlTimeout = 0; // this is used during NC startup-Time phase
563
                  else if(CamCtrlTimeout == 10000) CamCtrlTimeout = 0; // this is used during NC startup-Time phase
572
                  if((CamCtrlTimeout == 7000) || (CamCtrlTimeout == 1000))      I2CBus_StateReset(I2C0);
564
                 }
573
                 }
565
                else
574
                else
566
                 {
575
                 {
567
                  if(TrigLogging.CountExternal) CamCtrlCharacter = TrigLogging.CountExternal % 10 + '0';
576
                  if(TrigLogging.CountExternal) CamCtrlCharacter = TrigLogging.CountExternal % 10 + '0';