More work on NavMesh. Utilize A* search for mesh edges