opencv 自带直线拟合函数:
void fitLine(InputArray points, OutputArray line, int distType, double param, double reps, double aeps)
输入points:C++中一般定义为std::vector points;
输出line:C++中一般定义为std::vector lines;
第三个参数最重要,目前使用最为广泛的为最小二乘法(cv::DIST_L2),相比较其他参数效果更好,速度更优。
//根据输出的line,定义两条直线的输出分别为lineA、lineB
//定义直线方程:a1x+b1y+c1 = 0;a2x+b2y+c2 = 0;
//
double a1 = 0,b1 = 0, c1 = 0;
a1 = -lineA[1];
b1 = lineA[0];
c1 = -(lineA[2] * a1 + lineA[3] * b1);
double a2 = 0,b2 = 0, c2 = 0;
a2 = -lineB[1];
b2 = lineB[0];
c2 = -(lineB[2] * a2 + lineB[3] * b2);
//根据数学公式得到交点:
// x = (b1 * c2 - b2 * c1) / (a1 * b2 - a2 * b1)
// y = (a2 * c1 - a1 * c2) / (a1 * b2 - a2 * b1)
double A = (b1 * c2 - b2 * c1);
double B = (a2 * c1 - a1 * c2);
double C = (a1 * b2 - a2 * b1);
Point point;
point.x = (A / C);
point.y = (B / C);