Rev 1855 | Rev 1941 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 1855 | Rev 1916 | ||
|---|---|---|---|
| Line 68... | Line 68... | ||
| 68 | { |
68 | { |
| 69 | if(PlatinenVersion == 10) PORTD &= ~(1<<2); |
69 | if(PlatinenVersion == 10) PORTD &= ~(1<<2); |
| 70 | else PORTC &= ~(1<<7); |
70 | else PORTC &= ~(1<<7); |
| 71 | } |
71 | } |
| 72 | } |
72 | } |
| 73 | if(compass_active && !NaviDataOkay && EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV) |
73 | if(compass_active && !NaviDataOkay && Parameter_GlobalConfig & CFG_KOMPASS_AKTIV) |
| 74 | { |
74 | { |
| 75 | if(PINC & 0x10) |
75 | if(PINC & 0x10) |
| 76 | { |
76 | { |
| 77 | if(++cntKompass > 1000) compass_active = 0; |
77 | if(++cntKompass > 1000) compass_active = 0; |
| 78 | } |
78 | } |
| Line 356... | Line 356... | ||
| 356 | TCCR2A |= (1<<COM2A0); // make a low pulse |
356 | TCCR2A |= (1<<COM2A0); // make a low pulse |
| 357 | // set pulsewidth to stop pulse width |
357 | // set pulsewidth to stop pulse width |
| 358 | RemainingPulse = PPM_STOPPULSE; |
358 | RemainingPulse = PPM_STOPPULSE; |
| 359 | // accumulate time for correct sync gap |
359 | // accumulate time for correct sync gap |
| 360 | ServoFrameTime += RemainingPulse; |
360 | ServoFrameTime += RemainingPulse; |
| 361 | if((ServoActive && SenderOkay > 50) || ServoActive == 2) HEF4017R_OFF; // disable HEF4017 reset |
361 | if((ServoActive && SenderOkay) || ServoActive == 2) HEF4017R_OFF; // disable HEF4017 reset |
| 362 | else HEF4017R_ON; |
362 | else HEF4017R_ON; |
| 363 | ServoIndex++; // change to next servo channel |
363 | ServoIndex++; // change to next servo channel |
| 364 | if(ServoIndex > EE_Parameter.ServoNickRefresh) |
364 | if(ServoIndex > EE_Parameter.ServoNickRefresh) |
| 365 | { |
365 | { |
| 366 | CalculateServoSignals = 1; |
366 | CalculateServoSignals = 1; |