a couple of bug fixes. also anything below free_thresh in the map is now treated as an obstacle (no unknown space)