Fix navmesh test