This could be working, first succesfull testrun
almost working, minor bugs still
changed the map a bit. Still does not work in case there is no route,
but oh well..
Merge branch 'master' of https://github.com/JoonasMelin/ase_groupwork