Fix navmesh generating in places in shouldn't, potential fix for "navmesh failed to be created", and optimization of NPC path following