@Test
public void testThreePoints() {

    p1.setDivergence(0.4f);
    p2.setDivergence(1.1f);
    p3.setDivergence(0.6f);
    distanceSet.add(p1);
    distanceSet.add(p2);
    distanceSet.add(p3);
    NicGeoPoint dstPoint = interpolator.interpolatePosition(distanceSet);
    assertEquals(11f/6f, dstPoint.getX(), delta);
    assertEquals(15f/6f, dstPoint.getY(), delta);
}