Pathfinding on a navigation mesh