Navmesh now handles nonconvex obstacles

Still doesn't handle two touching obstacles