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