fix distanceBetweenWaypoints method
initial support for via points