Cleaned up code for Wall Following...