三维点直线拟合

#include <opencv2/opencv.hpp>

int main()
{
    cv::Vec6f& line
    std::vector<cv::Point3d> points;
    folat a = 0.1;
    folat b = 0.2;
    folat c = 0.3;
    folat x0 = 8;
    folat y0 = 9;
    folat z0 = 10;
    for(int z = 0;z<1000;z++)
    {
        Point3d p ;
        p.z = z;
        float t = z-z0/c;
        p.x = a*t + x0 +rng.gaussian(2);
        p.y = b*t +y0 +rng.gaussian(2);
        points.push_back(p);
         
    }
    /*
        (x-x0)/a = (y-y0)/b = (z-z0)/c :三维直线表达式
        line[0]:a
        line[0]:b
        line[0]:c
        line[0]:x0
        line[0]:y0
        line[0]:z0
    */
    cv::fitLine(points,line,CV_DIST_L2, 0, 0.01,0.01);
}