Vector3D orthoNormalize(Vector3D o) { final n1 = normalize(); final vn1 = n1.crossProduct(o).normalize(); setD(n1); return vn1.crossProduct(n1); }