public static boolean isInfiniteH ( Point4D_F64 p , double tol ) { double n = Math . sqrt ( p . x * p . x + p . y * p . y + p . z * p . z ) ; return Math . abs ( p . w ) <= n * tol ; }
Checks to see if the homogenous 3D point lies on the plane at infinity