Implemented controller to follow the wall at a certain distance.