最小二乘拟合空间圆C++代码

以下是使用C++实现最小二乘拟合空间圆的代码，其中使用了Eigen库来进行矩阵计算：

#include <iostream>
#include <vector>
#include <Eigen/Dense>

using namespace std;
using namespace Eigen;

// 最小二乘拟合空间圆
void circle_fit(const vector<Vector3d>& pts, Vector3d& c, double& r) {
    int n = pts.size();
    MatrixXd A(n, 3);
    VectorXd b(n);
    for (int i = 0; i < n; i++) {
        A(i, 0) = pts[i][0];
        A(i, 1) = pts[i][1];
        A(i, 2) = 1;
        b[i] = -pts[i].squaredNorm();
    }
    Vector3d x = (A.transpose() * A).inverse() * A.transpose() * b;
    c = Vector3d(x[0], x[1], -0.5 * x.squaredNorm());
    r = sqrt(c[0] * c[0] + c[1] * c[1] - 4 * c[2]);
}

int main() {
    vector<Vector3d> pts = {
        {1, 0, 0},
        {0, 1, 0},
        {-1, 0, 0},
        {0, -1, 0},
        {0, 0, 1}
    };
    Vector3d c;
    double r;
    circle_fit(pts, c, r);
    cout << "center: " << c.transpose() << endl;
    cout << "radius: " << r << endl;
    return 0;
}

在上述代码中，输入数据点集 `pts` 是一个三维向量的向量，表示每个数据点的坐标。输出圆的参数 `c` 和 `r` 分别表示圆心坐标和半径。需要注意的是，上述代码只适用于空间中的圆拟合，对于平面中的圆拟合需要做一些修改。