@Test
public void testToVecmathPoint() throws Exception {

    Point2d p = VecmathUtil.toVecmathPoint(new Point2D.Double(4, 2));
    assertThat(p.x, closeTo(4d, 0.01));
    assertThat(p.y, closeTo(2d, 0.01));
}