die funktion wait brauchst du nicht, da ja die erste shleife genausolange wartet wie noch kein entfernungsimpuls vorhanden ist.

wie soll das funktioniieren mit dem triggerimpuls? warum wird der gestartet bloss weil eine variable eins gesetzt wird?