Außerdem würde ich gerne verstehen, warum dieser Fehler auftritt.
Es wäre möglich, dass der Timer0 (der für die Servo-ISR) die Pulsein-Messung stört.

Probier mal, vor jeder Messung des US-Sensors Disable Timer0 und danach wieder Enable Timer0.

Gruß Dirk