OpenCV 直线拟合

转贴请注明出处！ 严禁商业用途

出处： http://blog.csdn.net/Tangyongkang/

翻译自： http://www.eml.ele.cst.nihon-u.ac.jp/~momma/wiki/wiki.cgi/OpenCV/%E7%9B%B4%E7%B7%9A%E3%81%AE%E3%83%95%E3%82%A3%E3%83%83%E3%83%86%E3%82%A3%E3%83%B3%E3%82%B0.html

 

OpenCV中 CvSeq 对象由以下语句生成

 

  //创建 CvSeq的容器对象

   CvMemStorage* storage = cvCreateMemStorage(0);

 // 创建 CvSeq对象
 
 // 第一个参数  生成后的序列的标志( 不甚解)
 
 // 第二个参数 队列（Sequence）头的Size
 
 // 第三个参数  节点的Size

 // 第四个参数  存储CvSeq的容器对象
 
 CvSeq* point_seq = cvCreateSeq( CV_32FC2, sizeof(CvSeq), sizeof(CvPoint2D32f), storage );

 

用完后，以下列形式释放内存

  cvClearSeq(point_seq);
 
 cvReleaseMemStorage(&storage);

 向CvSeq中添加数据时：

cvSeqPush(point_seq, &cvPoint2D32f(x坐标,y坐标));


 FitLine函数的用法：

// 二维空间点拟合时 是 float[4]
 // 三位空间点拟合时 是 float[6]
float *line = new float[4];
 // 第一个参数： 存储点序列

// 第二个参数： 拟合算法，其中 CV_DIST_L2 就是平常的最小二乘法
 // 第三，第四，第五参数推荐值是 0,   0.01,  0.01,

// 第六参数： line中存储返回值
 // 二维空间时： line[0--3] 分别为 (vx, vy, x0, y0)

//      其中 vx， vy 是正规化之后的斜率向量。 x0,y0 是直线经过的点。
 // 三维空间时： line[0--5]  分别是 (vx, vy, vz, x0, y0, z0) 。
意义同上
cvFitLine(point_seq,CV_DIST_L2,0,0.01,0.01,line);


 拟合程序：：


#include <cv.h>

#include <stdio.h>

#include <math.h>

float myLinearity(CvSeq *);
 int main(void)

{

int i;
 double fx[] = {0.0, 0.301, 0.477, 0.602, 0.699, 0.778, 0.845, 0.903, 0.954, 1.0};

double fy[] = {3.874, 3.202, 2.781, 2.49, 2.274, 2.156, 1.934, 1.74, 1.653, 1.662};
 float *line = new float[4];

float linearity=0.0f;
//Sequence的容器
 CvMemStorage* storage = cvCreateMemStorage(0);
//三维空间的话，把CV_32FC2改为CV_32FC3、 把CvPoint2D32f 改为 
CvPoint3D32f
CvSeq* point_seq = cvCreateSeq( CV_32FC2, sizeof(CvSeq), sizeof(CvPoint2D32f), storage );
 for (i=0; i<10; i++)
{
//向Sequence中追加元素
 cvSeqPush(point_seq, &cvPoint2D32f(fx[i],fy[i]));
 }
 linearity = myLinearity(point_seq);
 cvFitLine(point_seq,CV_DIST_L2,0,0.01,0.01,line);

fprintf(stdout,"v=(%f,%f),vy/vx=%f,(x,y)=(%f,%f), Linearity=%f/n",line[0],line[1],line[1]/line[0],line[2],line[3],linearity);

cvClearSeq(point_seq);
cvReleaseMemStorage(&storage);
return 0;

}


//计算直线拟合度
float myLinearity(CvSeq *seq)
{
	int i;
	CvPoint2D32f *p;
	float *x = new float[seq->total];
	float *y = new float[seq->total];
	float x_bar=0.0, y_bar=0.0;
	float u11=0.0, u20=0.0, u02=0.0;
	float linearity=0.0;
	
	for (i=0; i < seq->total; i++){
		p=(CvPoint2D32f*)cvGetSeqElem(seq,i);
		x[i]=p->x;
		y[i]=p->y;
	}
	//x_bar, y_bar
	for (i=0; i < seq->total; i++){
		x_bar+=x[i];
		y_bar+=y[i];
	}
	x_bar/=seq->total;
	y_bar/=seq->total;
	
	for (i=0; i < seq->total; i++){
		u11+=((x[i]-x_bar)*(y[i]-y_bar));
		u20+=pow(x[i]-x_bar,2.0f);
		u02+=pow(y[i]-y_bar,2.0f);
	}
	u11/=seq->total;
	u20/=seq->total;
	u02/=seq->total;
	
	//计算直线度
	linearity = sqrt(4*pow(u11,2.0f)+pow(u20-u02,2.0f))/(u20+u02);
	return linearity;
}

 

**运行结果
v=(0.399377,-0.916787),vy/vx=-2.295543,(x,y)=(0.655900,2.376600), Linearity=0.999105