opencv最小二乘拟合平面

最新推荐文章于 2024-11-15 17:23:36 发布

每天进步一点点222

最新推荐文章于 2024-11-15 17:23:36 发布

阅读量1.9k

点赞数 1

本文链接：https://blog.csdn.net/qq_15805507/article/details/62889194

版权

这段代码展示了如何使用OpenCV库来实现三维空间中四个点的平面拟合。通过计算矩阵及其逆矩阵，求解得到平面方程的系数，从而完成平面的最小二乘拟合。

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

//平面拟合（Ax+By+Cz+1=0）    
void cvFitPlane()    
{    
    double array[4][3],Y[3];//待拟合的点    
    ZeroMemory(array,sizeof(array));//分配内存空间    
    ZeroMemory(Y,sizeof(Y));    
    array[0][0]=1;    
    array[0][1]=-1;    
    array[0][2]=1;    
    array[1][0]=0;    
    array[1][1]=1;    
    array[1][2]=2;    
    array[2][0]=1;    
    array[2][1]=1;    
    array[2][2]=3;    
    array[3][0]=-1;    
    array[3][1]=-1;    
    array[3][2]=-1;    
    double *Matrix[3],*IMatrix[3];    
    for (int i = 0;i < 3;i++)    
    {    
        Matrix[i]  = new double[3];//矩阵与其逆矩阵相乘    
    }    
    for (int i = 0;i < 3;i++)    
    {    
        for (int j = 0;j < 3;j++)    
        {    
            *(Matrix[i] + j) = 0.0;    
        }    
    }    
    
    for (int j = 0;j < 3;j++)    
    {    
        fo