Road graph waypoint additions, snapping to endpoints