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'; |