| 5,6 → 5,7 |
|---|
| volatile unsigned char UpdateMotor = 0; |
| volatile unsigned int cntKompass = 0; |
| volatile unsigned int beeptime = 0; |
| unsigned int BeepMuster = 0xffff; |
| int ServoValue = 0; |
| |
| enum { |
| 22,6 → 23,7 |
|---|
| SIGNAL (SIG_OVERFLOW0) // 8kHz |
| { |
| static unsigned char cnt_1ms = 1,cnt = 0; |
| unsigned char pieper_ein = 0; |
| // TCNT0 -= 250;//TIMER_RELOAD_VALUE; |
| |
| if(!cnt--) |
| 31,17 → 33,35 |
|---|
| cnt_1ms %= 2; |
| if(!cnt_1ms) UpdateMotor = 1; |
| CountMilliseconds++; |
| if(Timeout) Timeout--; |
| } |
| |
| if(beeptime > 1) |
| { |
| beeptime--; |
| PORTD |= (1<<2); |
| beeptime--; |
| if(beeptime & BeepMuster) |
| { |
| pieper_ein = 1; |
| } |
| else pieper_ein = 0; |
| } |
| else |
| { |
| pieper_ein = 0; |
| BeepMuster = 0xffff; |
| } |
| |
| |
| if(pieper_ein) |
| { |
| if(PlatinenVersion == 10) PORTD |= (1<<2); // Speaker an PORTD.2 |
| else PORTC |= (1<<7); // Speaker an PORTC.7 |
| } |
| else |
| PORTD &= ~(1<<2); |
| |
| { |
| if(PlatinenVersion == 10) PORTD &= ~(1<<2); |
| else PORTC &= ~(1<<7); |
| } |
| |
| if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV) |
| { |
| if(PINC & 0x10) |
| 127,7 → 147,6 |
|---|
| if(ServoValue < EE_Parameter.ServoNickMin) ServoValue = EE_Parameter.ServoNickMin; |
| else if(ServoValue > EE_Parameter.ServoNickMax) ServoValue = EE_Parameter.ServoNickMax; |
| |
| DebugOut.Analog[10] = ServoValue; |
| OCR2A = ServoValue;// + 75; |
| timer = EE_Parameter.ServoNickRefresh; |
| } |