NavigationForUnity This project includes many kinds of Pathfinding algorithm.You can learn and optimize these algorithms