Moved mesh code into new Navmesh class