More NavMesh2D bug fixes