plan fails when gcode waypoints are too wide apart
interpolate waypoints to max of x cm apart to prevent contour trajectory failling to find nearby solutions.
interpolate waypoints to max of x cm apart to prevent contour trajectory failling to find nearby solutions.