@Test
public void testNormalize_Point3d() {

    Point3d p = new Point3d(1, 1, 0);
    GeometryTools.normalize(p);
    Assert.assertEquals(p.x, 0.7, .1);
    Assert.assertEquals(p.y, 0.7, .1);
    Assert.assertEquals(p.z, 0.0, .1);
}