Entfernungsmessung mit Ultraschall

Hallo!

Ich komme mit der Nachbau einer Schaltung nicht mehr weiter und möchte 
euch mal fragen, ob mir jemand helfen kann.

Ich habe eine Schaltung zur Entfernungsmessung mit Ultraschallsensoren 
nach dieser Anleitung nachgebaut: 
http://www.mikrocontroller.net/articles/Entfernungsmessung_mit_Ultraschall 
.

Ich benutze ATmega2560 und programmiere in C. Dazu habe ich den in dem 
gleichen Thread veröffentlicheten Sourcecode benutzt, nur die Register 
wurden an meinen Controler entsprechend angepasst.

Das Problem ist: Timer2-Interrupt wird nicht ausgeführt und die vom 
Empfänger aufgennomene Messwerte werden in ein Array nicht aufgenommen.

Ich habe das Programm mit AVR Studio simuliert und mir ist etwas 
aufgefallen. Hier ist C-Code von den beiden Timer-Interrupts:

1

ISR (TIMER0_OVF_vect) 

2

{    

3

  if (pulse) 

4

  {

5

    DDRE |= (1<<PE3);

6

    pulse = 0;

7

    return;

8

  }

9

10

  else

11

  {

12

    DDRE &= ~(1<<PE3);

13

    TCNT2 = 0;        

14

    TIMSK2 |= (1<<TOIE2);

15

    TIMSK0 &= ~(1<<TOIE0);

16

  }

17

}

18

19

20

ISR (TIMER2_OVF_vect) 

21

{

22

  ADCSRA |= (1<<ADSC);

23

  while (ADCSRA & (1<<ADSC));

24

  rec_buffer [i] = ADC;

25

  ADC = 0;

26

  i++;

27

  if (i == 400) 

28

  {

29

    i = 0;

30

    receive_complete = 1;

31

    TIMSK2 &= ~(1<<TOIE2);

32

  }

33

}

Im ersten ISR-Block wird erstmal die if-Anweisung ausgeführt, Variable 
"pulse" auf 0 gesetzt und dementsprechend soll das Programm bei "else" 
wieder reinspringen und damit Timer2 aktivieren und Timer0 deaktivieren. 
In Wirklichkeit springt das Programm nach Verlassen der if-Anweisung 
wieder aus der Interrupt-Routine raus und Timer2 wird nicht aktiviert.

Was mache ich falsch? Was kann ich machen, damit das Programm in den 
else-Block reingeht?

Kann mir jemand weiterhelfen?

Gruß, Oleg