| 32,10 → 32,10 |
|---|
| * init ppm, including timer1 for measurement |
| */ |
| void ppm_init() { |
| PORTE |= (1 << PORTE0); // enable pullup on INT0 pin |
| GICR |= (1<<INT2); // External Interrupt Request 2 Enable |
| EMCUCR |= (1<<ISC2); // a rising edge on INT2 activates the interrupt |
| TCCR1B |= (0<<CS12)|(1<<CS10)|(1<<CS11); // timer1 up with prescaler 64 |
| PORTE |= (1 << PORTE0); // enable pullup on INT0 pin |
| GICR |= (1 << INT2); // External Interrupt Request 2 Enable |
| EMCUCR |= (1 << ISC2); // a rising edge on INT2 activates the interrupt |
| TCCR1B |= (0 << CS12) | (1 << CS10) | (1 << CS11); // timer1 up with prescaler 64 |
| } |
| |
| /** |
| 42,36 → 42,36 |
|---|
| * Handle INT2 interrupts that occur on changing edges of ppm signal |
| */ |
| ISR(INT2_vect) { |
| // since the pin might get bogus reads we wait for 123 signals |
| static uint8_t valid_ppm_to_go = 123; |
| if (EMCUCR & (1<<ISC2)) { // rising |
| old_timer1 = TCNT1; |
| EMCUCR &= ~(1<<ISC2); // next one is falling |
| } else { |
| if (valid_ppm_to_go) { |
| valid_ppm_to_go--; |
| } else { |
| ppm = TCNT1 - old_timer1; |
| ppm -= 256; |
| if (ppm < 128) { // we want HUD |
| if (!(COSD_FLAGS_MODES & COSD_FLAG_HUD)) { |
| COSD_FLAGS_RUNTIME &= ~COSD_ICONS_WRITTEN; |
| } |
| COSD_FLAGS_MODES |= COSD_FLAG_HUD; |
| } else { // we do not want hud |
| if (COSD_FLAGS_MODES & COSD_FLAG_HUD) { |
| clear(); |
| } |
| COSD_FLAGS_MODES &= ~COSD_FLAG_HUD; |
| } |
| } |
| EMCUCR |= (1<<ISC2); // next one is rising |
| } |
| //write_ndigit_number_u(2, 5, ppm, 1000, 0); // debug |
| //write_ndigit_number_u(2, 6, valid_ppm_to_go, 100, 0); // debug |
| //write_ndigit_number_u(2, 7, COSD_FLAGS_CONFIG, 100, 0); // debug |
| PORTC ^= (1 << PC3); |
| uptime = ppm; |
| // since the pin might get bogus reads we wait for 123 signals |
| static uint8_t valid_ppm_to_go = 123; |
| if (EMCUCR & (1 << ISC2)) { // rising |
| old_timer1 = TCNT1; |
| EMCUCR &= ~(1 << ISC2); // next one is falling |
| } else { |
| if (valid_ppm_to_go) { |
| valid_ppm_to_go--; |
| } else { |
| ppm = TCNT1 - old_timer1; |
| ppm -= 256; |
| if (ppm < 128) { // we want HUD |
| if (!(COSD_FLAGS_MODES & COSD_FLAG_HUD)) { |
| COSD_FLAGS_RUNTIME &= ~COSD_ICONS_WRITTEN; |
| } |
| COSD_FLAGS_MODES |= COSD_FLAG_HUD; |
| } else { // we do not want hud |
| if (COSD_FLAGS_MODES & COSD_FLAG_HUD) { |
| clear(); |
| } |
| COSD_FLAGS_MODES &= ~COSD_FLAG_HUD; |
| } |
| } |
| EMCUCR |= (1 << ISC2); // next one is rising |
| } |
| //write_ndigit_number_u(2, 5, ppm, 1000, 0); // debug |
| //write_ndigit_number_u(2, 6, valid_ppm_to_go, 100, 0); // debug |
| //write_ndigit_number_u(2, 7, COSD_FLAGS_CONFIG, 100, 0); // debug |
| PORTC ^= (1 << PC3); |
| uptime = ppm; |
| } |
| |
| #endif |