Gratuliere, bei der Realisierung im Detail schlage ich folgenden Ansatz vor:

TSOP zur Hinderniserkennung: Lösung

https://www.roboternetz.de/phpBB2/ze...=tsop+l%F6sung