Das sieht etwas verworren aus...

Das ICR1 solltest du in der ISR sichert, und ein Flag setzen, daß die Messung fertig ist, ebenso wie in OCR1B (dient wohl als Timeout).