Follow wall initial
Startet work on wall follow