Final Wall Follower code