c++代码实现
void LineFitLeastFit(const std::vector<cv::Point2f> &_points,float & _k,float & _b,float & _r) {
float B = 0.0f;
float A = 0.0f;
float D = 0.0f;
float C = 0.0f;
int N = _points.size();
for (int i = 0; i < N; i++)
{
B += _points[i].x;
A += _points[i].x * _points[i].x;
D += _points[i].y;
C += _points[i].x * _points[i].y;
}
if ((N * A - B * B) == 0)
return;
_k = (N * C - B * D) / (N * A - B * B);
_b = (A * D - C * B) / (N * A - B * B);
//计算相关系数
float Xmean = B / N;
float Ymean = D / N;
float tempX = 0.0f;
float tempY = 0.0f;
float rDenominator = 0.0;
for (int i = 0; i < N; i++)
{
tempX += (_points[i].x - Xmean) * (_points[i].x - Xmean);
tempY += (_points[i].y - Ymean) * (_points[i].y - Ymean);
rDenominator += (_points[i].x - Xmean) * (_points[i].y - Ymean);
}
float SigmaXY = sqrt(tempX) * sqrt(tempY);
if (SigmaXY == 0)
return;
_r = rDenominator / SigmaXY;
}
运行结果:
opencv验证结果: