working on better geometries start and ending
neat path around end points with updated distance & time
print debug info