Adding checkpoint system for pathfinding