Fix voor routes met teveel bochten

De routeplanner hield geen rekening met de startpositie van de robot bij
checkpoints. Nu wel