fixes, er kan nu meerdere malen een pad berekend worden

TODO: kosten voor bochten toevoegen