point matching algorithm is wrong

the surface of the ellipsoid is not followed. need to include the third
axis in surface minimization calculation