Look for nearest freespace if inside an obstacle
Merge branch 'master' of https://github.com/jlsorrells/rbe3002lab3