Added AStar pathfinding
Navmesh updated
Drastically improved NavMesh generation speed