@Test
public void testSinglePoint() {

    p1.setDivergence(4.0f);
    distanceSet.add(p1);
    NicGeoPoint dstPoint = interpolator.interpolatePosition(distanceSet);
    assertEquals(p1.getX(), dstPoint.getX(), delta);
    assertEquals(p1.getY(), dstPoint.getY(), delta);
}