最小二乘法拟合_最小二乘法拟合平面

最新推荐文章于 2023-04-29 18:32:50 发布

tomorrow-77

最新推荐文章于 2023-04-29 18:32:50 发布

阅读量629

点赞数

文章标签：最小二乘法拟合

本文链接：https://blog.csdn.net/weixin_39946355/article/details/111617805

版权

本文探讨了最小二乘法在拟合数据方面的应用，通过代码实现展示了如何利用最小二乘法进行平面拟合。文章包括理论讲解和实际结果的展示，为读者提供了直观的理解和操作指南。

摘要由CSDN通过智能技术生成

代码实现

#include 
#include 
#include 
#include 
#include 
#include 
#include 
#include 

using namespace std;
using namespace Eigen;


/* 最小二乘法拟合平面：Ax + By + Cz + D = 0 */
/* Parameters：返回参数A B C D */
/* point：存放输入点 */
bool FitPlaneByLeastSquares(pcl::PointCloud<:pointxyz>&point,vector<double>& Parameters){
    
    Parameters.clear();
    int count = point.size();
    if (count 3)
    {
    
        return false;
    }

    double meanX = 0, meanY = 0, meanZ = 0;
    double meanXX = 0, meanYY = 0, meanZZ = 0;
    double meanXY = 0, meanXZ = 0, meanYZ = 0;
    for (int i =