C++:最小二乘法 拟合圆

一、推导

二、分享给有需要的人,代码质量勿喷。

void xjLeastSquares::FitCenterByLeastSquares(std::map<int, std::vector<double>> mapPoint, std::vector<double> &centerP, double &radius)
{
	double sumX = 0, sumY = 0;
	double sumXX = 0, sumYY = 0, sumXY = 0;
	double sumXXX = 0, sumXXY = 0, sumXYY = 0, sumYYY = 0;

	for (std::map<int, std::vector<double>>::iterator it = mapPoint.begin(); it != mapPoint.end(); ++it)
	{
		std::vector<double> p = it->second;

		sumX += p[0];
		sumY += p[1];
		sumXX += p[0] * p[0];
		sumYY += p[1] * p[1];
		sumXY += p[0] * p[1];
		sumXXX += p[0] * p[0] * p[0];
		sumXXY += p[0] * p[0] * p[1];
		sumXYY += p[0] * p[1] * p[1];
		sumYYY += p[1] * p[1] * p[1];
	}

	int pCount = mapPoint.size();
	double M1 = pCount * sumXY - sumX * sumY;
	double M2 = pCount * sumXX - sumX * sumX;
	double M3 = pCount * (sumXXX + sumXYY) - sumX * (sumXX + sumYY);
	double M4 = pCount * sumYY - sumY * sumY;
	double M5 = pCount * (sumYYY + sumXXY) - sumY * (sumXX + sumYY);

	double a = (M1 * M5 - M3 * M4) / (M2*M4 - M1 * M1);
	double b = (M1 * M3 - M2 * M5) / (M2*M4 - M1 * M1);
	double c = -(a * sumX + b * sumY + sumXX + sumYY) / pCount;

	//圆心XY 半径
	double xCenter = -0.5*a;
	double yCenter = -0.5*b;
	radius = 0.5 * sqrt(a * a + b * b - 4 * c);
	centerP[0] = xCenter;
	centerP[1] = yCenter;
}

 

  • 8
    点赞
  • 48
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 7
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 7
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

累了就要打游戏

把我养胖,搞代码

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值