python 最小二乘法三维坐标拟合平面_最小二乘法拟合平面。

本文采用了opencv的一些函数来对平面进行拟合。

//Ax+by+cz=D

void cvFitPlane(const CvMat* points, float* plane){

// Estimate geometric centroid.

int nrows = points->rows;

int ncols = points->cols;

int type = points->type;

CvMat* centroid = cvCreateMat(1, ncols, type);

cvSet(centroid, cvScalar(0));

for (int c = 0; c

for (int r = 0; r < nrows; r++)

{

centroid->data.fl[c] += points->data.fl[ncols*r + c];

}

centroid->data.fl[c] /= nrows;

}

// Subtract geometric centroid from each point.

CvMat* points2 = cvCreateMat(nrows, ncols, type);

for (int r = 0; r

for (int c = 0; c

points2->data.fl[ncols*r + c] = points->data.fl[ncols*r + c] - centroid->data.fl[c];

// Evalua