Subfunction that does only fit on 2d points (no matrix rotation).
Fixed the quadratic to cartesian conversion.