Added checkpoints classes + Modified PathFinding