finished WallFollower algo