Ich kann das programm leider erst morgen testen.
Bei der berechnung der Distanz habe ich mich vertippt.

Aber prinzipiell sollten die Befehle für die Übertragung von einzelnen Bytes trotzdem funktionieren. Ich bin nicht mal sicher ob das senden des ersten Bytes funktioniert, da die LED, die bei jeder Messung aufleuchten soll, nicht blinkte.

Vielleicht sieht ja jemand noch einen Fehler in meinem Quellcode.

mfg WarChild