Add the plane fitting algorithm
given a set of points and fitting the best fit plane
by least square methods and solve by single value decomposition