Code for exercise 6 the wall follower.