Pathfinding units with vector