Fixed waypoints so that it uses the navmesh

npc uses navmesh to go between waypoints. Can navigate through and
around objects and buildings that have been added to the navmesh