使用C++:输入坐标点集x/y，使用三次多项式进行轨迹插值，输出轨迹点坐标

好的，以下是使用C++实现输入坐标点集x/y，使用三次多项式进行轨迹插值，输出轨迹点坐标的代码：

#include <iostream>
#include <vector>
#include <cmath>

using namespace std;

// 计算三次多项式的系数
void cubic_interpolation(vector<double>& x, vector<double>& y, vector<double>& a)
{
    // 计算一阶差商
    vector<double> delta1(y.size() - 1);
    for (int i = 0; i < delta1.size(); i++) {
        delta1[i] = (y[i+1] - y[i]) / (x[i+1] - x[i]);
    }

    // 计算二阶差商
    vector<double> delta2(delta1.size() - 1);
    for (int i = 0; i < delta2.size(); i++) {
        delta2[i] = (delta1[i+1] - delta1[i]) / (x[i+2] - x[i]);
    }

    // 计算三阶差商
    vector<double> delta3(delta2.size() - 1);
    for (int i = 0; i < delta3.size(); i++) {
        delta3[i] = (delta2[i+1] - delta2[i]) / (x[i+3] - x[i]);
    }

    // 计算系数a
    for (int i = 0; i < a.size(); i++) {
        if (i == 0 || i == a.size() - 1) {
            a[i] = 0;
        } else {
            double d1 = x[i] - x[i-1];
            double d2 = x[i+1] - x[i];
            a[i] = 3 * delta1[i-1] - 3 * delta1[i] + d1 * delta2[i-1] + d2 * delta2[i];
            a[i] /= pow(d1, 2) * (d1 + d2);
            a[i] += (delta3[i-1] - delta3[i]) / (6 * (d1 + d2));
        }
    }
}

// 根据系数a计算拟合函数的值
double cubic_function(double x, vector<double>& a, vector<double>& x0)
{
    int i = 0;
    while (i < x0.size() && x > x0[i]) {
        i++;
    }
    i--;

    double d = x - x0[i];
    double result = a[i] * pow(d, 3) + a[i+1] * pow(d, 2);
    result += a[i+2] * d + a[i+3];
    return result;
}

int main()
{
    // 输入坐标点集x/y
    vector<double> x = {0, 1, 2, 3, 4, 5};
    vector<double> y = {1, 2, 3, 5, 8, 13};

    // 计算系数a
    vector<double> a(y.size());
    cubic_interpolation(x, y, a);

    // 输出轨迹点坐标
    vector<double> x0;
    double step = 0.1;
    for (double i = x[0]; i <= x[x.size()-1]; i += step) {
        x0.push_back(i);
    }

    for (int i = 0; i < x0.size(); i++) {
        double y0 = cubic_function(x0[i], a, x);
        cout << "(" << x0[i] << ", " << y0 << ")" << endl;
    }

    return 0;
}

运行以上代码，即可得到轨迹点的坐标。注意，以上代码仅为示例，实际使用时需要根据具体的需要进行修改。