最小二乘法拟合直线 C++/OpenCV

问题:
我们在拥有一系列散列的点(x1,y1),(x2,y2)... (xm,ym),这些点在一条直线附近,通过点拟合直线。我在工程中是要拟合一系列线段,其实一条线段就对应着两个要拟合的点,算法上稍有区别,原理完全一致。思路一:用OpenCV自带的最小二乘法拟合函数:cvFitLine()void cvFitLine( const CvArr points, int dist_type, double param, double reps, double aeps, float line );points

2D 或 3D 点集,32-比特整数或浮点数坐标 ,存放输入点。

Char cvSeqPush(CvSeq seq,void element=NULL)*

功能:存放元素到序列尾部。

dist_type

拟合的距离类型.

dist_type=CV_DIST_L2 (L2): ρ(r)=r2/2 (最小二乘法,我们要用的)

dist_type=CV_DIST_L1 (L1): ρ(r)=r

dist_type=CV_DIST_L12 (L1-L2): ρ(r)=2?[sqrt(1+r2/2) - 1]

dist_type=CV_DIST_FAIR (Fair): ρ(r)=C2?[r/C - log(1 + r/C)], C=1.3998

dist_type=CV_DIST_WELSCH (Welsch): ρ(r)=C2/2?[1 - exp(-(r/C)2)], C=2.9846

dist_type=CV_DIST_HUBER (Huber): ρ(r)= r2/2, if r < C; C?(r-C/2), otherwise; C=1.345

param

对某些距离的数字参数,如果是 0, 则选择某些最优值

reps, aeps

半径 (坐标原点到直线的距离) 和角度的精度,一般设为0.01。

line

输出的直线参数。2D 拟合情况下,它是包含 4 个浮点数的数组 (vx, vy, x0, y0),其中 (vx, vy) 是线的单位向量而 (x0, y0) 是线上的某个点.

对 3D 拟合,它是包含 6 个浮点数的数组 (vx, vy, vz, x0, y0, z0), 其中 (vx, vy, vz) 是线的单位向量,而 (x0, y0, z0) 是线上某点。

1         float *line = new float[4];
 2         CvMemStorage* storage = cvCreateMemStorage(0);
 3         
 4         //往点序列中存放需要参与拟合直线的点
 5         CvSeq* point_seq = cvCreateSeq( CV_32FC2, sizeof(CvSeq), sizeof(CvPoint2D32f), storage );
 6         for(int j=0;j<temp.size();j++)
 7         {
 8             cvSeqPush(point_seq, &cvPoint2D32f(temp[j].stPot().x,temp[j].stPot().y));
 9             cvSeqPush(point_seq, &cvPoint2D32f(temp[j].enPot().x,temp[j].enPot().y));
10         }
11 
12         cvFitLine(point_seq,CV_DIST_L2,0,0.01,0.01,line);   //CV_DIST_L2表示最小二乘法
13 
14         //line[0],line[1]为x,y的单位方向向量
15         //line[2],line[3]为直线经过某点的X,Y值
16         //正好组成参数方程
17         //X=line[0]t+line[2]
18         //Y=line[1]t+line[3]
19         
20         //根据line[4]计算自己需要的直线或线段
21         Point A(0,line[3]-(line[1]*line[2]/line[0]));
22         Point B(src->width,(src->width-line[2])*line[1]/line[0]+line[3]);
23         cvLine(src,A,B,CV_RGB(255,0,0),3,8,0);
24 
25         cvClearSeq(point_seq);
26         cvReleaseMemStorage(&storage);

思路二:

自己写算法,但是需要注意,openCV中原点在屏幕的左上角,与我们数学中的直角坐标系不太一样。

1 //最小二乘法拟合直线
 2 void line_fit(vector<MyLine>& h,IplImage* src)
 3 {
 4     int n = 2*h.size();
 5     int k;                       //目标直线斜率
 6     int b;                       //目标直线截距
 7     vector<MyLine>::iterator it = h.begin();
 8     int sumx=0,sumy=0,sumxy=0,sumxsq=0;
 9     while(it != h.end())
10     {
11         sumx += it->stPot().x;
12         sumx += it->enPot().x;
13         sumy += it->stPot().y;
14         sumy += it->enPot().y;
15         sumxy += it->stPot().x*it->stPot().y;
16         sumxy += it->enPot().x*it->enPot().y;
17         sumxsq += it->stPot().x*it->stPot().x;
18         sumxsq += it->enPot().x*it->enPot().x;
19         it++;
20     }
21     
22     if(sumxsq == (sumx*sumx/n))
23         k = atan2(0,1.0);
24     else
25         k = (sumxy-((sumx*sumy)/n))/(sumxsq-(sumx*sumx/n));
26     b = (sumy-k*sumx)/n;
27     cvLine(src,Point(0,b),Point(src->width,k*src->width+b),CV_RGB(255,0,0),1,8,0);
28 }





原文链接: https://www.cnblogs.com/zjuthantics/p/4717186.html

欢迎关注

微信关注下方公众号,第一时间获取干货硬货;公众号内回复【pdf】免费获取数百本计算机经典书籍

原创文章受到原创版权保护。转载请注明出处:https://www.ccppcoding.com/archives/220401

非原创文章文中已经注明原地址,如有侵权,联系删除

关注公众号【高性能架构探索】,第一时间获取最新文章

转载文章受原作者版权保护。转载请注明原作者出处!

(0)
上一篇 2023年2月13日 上午10:54
下一篇 2023年2月13日 上午10:54

相关推荐