@Test
public void testTwoPoints() {

    p1.setDivergence(0.5f);
    p2.setDivergence(0.3f);
    distanceSet.add(p1);
    distanceSet.add(p2);
    NicGeoPoint dstPoint = interpolator.interpolatePosition(distanceSet);
    assertEquals(2.875f, dstPoint.getX(), delta);
    assertEquals(2.375f, dstPoint.getY(), delta);
}