Added comments for functions
Made changes to be tested for turning around wall when harder to detect.