| 132,7 → 132,8 |
|---|
| /*****************************************************/ |
| /* Interrupt Routine of Timer 0 */ |
| /*****************************************************/ |
| ISR(TIMER0_OVF_vect) { // 9765.625 Hz |
| ISR(TIMER0_OVF_vect) |
| { // 9765.625 Hz |
| static uint8_t cnt_1ms = 1,cnt = 0; |
| uint8_t Beeper_On = 0; |
| |
| 152,11 → 153,12 |
|---|
| // beeper on if duration is not over |
| if(BeepTime) { |
| BeepTime--; // decrement BeepTime |
| if(BeepTime & BeepModulation) Beeper_On = 1; |
| else Beeper_On = 0; |
| } |
| else { // beeper off if duration is over |
| if (BeepTime & BeepModulation) |
| Beeper_On = 1; |
| else |
| Beeper_On = 0; |
| } else { // beeper off if duration is over |
| Beeper_On = 0; |
| BeepModulation = 0xFFFF; |
| } |
| |
| 163,12 → 165,16 |
|---|
| // if beeper is on |
| if(Beeper_On) { |
| // set speaker port to high. |
| if(BoardRelease == 10) PORTD |= (1<<PORTD2); // Speaker at PD2 |
| else PORTC |= (1<<PORTC7); // Speaker at PC7 |
| if (BoardRelease == 10) |
| PORTD |= (1 << PORTD2); // Speaker at PD2 |
| else |
| PORTC |= (1 << PORTC7); // Speaker at PC7 |
| } else { // beeper is off |
| // set speaker port to low |
| if(BoardRelease == 10) PORTD &= ~(1<<PORTD2);// Speaker at PD2 |
| else PORTC &= ~(1<<PORTC7);// Speaker at PC7 |
| if (BoardRelease == 10) |
| PORTD &= ~(1 << PORTD2);// Speaker at PD2 |
| else |
| PORTC &= ~(1 << PORTC7);// Speaker at PC7 |
| } |
| |
| #ifndef USE_NAVICTRL |
| 194,7 → 200,8 |
|---|
| // ----------------------------------------------------------------------- |
| void Delay_ms(uint16_t w) { |
| uint16_t t_stop = SetDelay(w); |
| while (!CheckDelay(t_stop)); |
| while (!CheckDelay(t_stop)) |
| ; |
| } |
| |
| // ----------------------------------------------------------------------- |