Xmega128A1-Proximity Sensor funkt. nicht

Hallo,

ich muss mit AVR Xmega128a1 den Proximity-Sensor SRF01 in C
programmieren.Der Sensor soll mir nur sagen ob vor ihm ein Objekt ist 
oder nicht. Z.b, wenn Objekt da ist ein Led leuchtet wenn nicht, nicht.

Dafür habe ich für den gleichen Sensor ein Sample-Code mit ATMega32 
gefunden, "lcd" teil auskommentiert da ich keine anzeige brauche und an 
Xmega128a1 angepasst. Wenn man combiliert,bekommt man keine Errors aber 
sensor funktioniert nicht. Ich kann den Fehler leider nicht finden.
Hier poste ich die Codes.

Kann jemand mir bitte beim suchen/finden des fehlers helfen??

Vielen Dank im Voraus