Wall follow works, approach could be smoother