问OpenCV c++中的多项式曲线拟合

EN

PolynomialFit(std::vector<cv::Point>& points, int order) {

    cv::Mat U(points.size(), (order + 1), CV_64F);
    cv::Mat Y(points.size(), 1, CV_64F);
    
    for (int i = 0; i < U.rows; i++) {
        for (int j = 0; j < U.cols; j++) {
            U.at<double>(i, j) = pow(points[i].x, j);
        }
    }
     
    for (int i = 0; i < Y.rows; i++) {
        Y.at<double>(i, 0) = points[i].y;
    }

    cv::Mat K((order + 1), 1, CV_64F);
    if(U.data != NULL) {
        K = (U.t() * U).inv() * U.t() * Y;
    }

int order = 2;
        cv::Mat K = PolynomialFit(_points, order);
        
        if(_points.size() > 0) {
            for (int j = _points.at(0).x; j < _points.at(_points.size() - 1).x; j++) {

                cv::Point2d point(j, 0);
                for (int k = 0; k < order + 1; k++) {
                    point.y += K.at<double>(k, 0) * std::pow(j, k);
                }
                
                cv::circle(image, point, 1, cv::Scalar(0, 255, 0), CV_FILLED, CV_AA);
            }
        }