Ran into issue where checking any sensors causes drone to not fly forward. This version wrapped everything inside the range values so if it is farther than rangeStop it will continue with regular flight. This will probably be giving me the same issue but it's a change to try.