Updated obstacle detection, plus tool changes

Updated the obstacle detection to make it better. Made a bunch of changes to the offline vision tool, including some geometry changes. Definitely make sure that I haven't done anything with geometry that would affect other people.