C++ rs曲线 实现目标点与终点位置重合，方向逆时针旋转20度

在C++中，要实现一个从目标点到终点的逆时针旋转20度的RS曲线（贝塞尔曲线），通常会使用Bezier曲线的原理。RS曲线，也称为Rational Spline Curve，是基于控制点的一组Bézier曲线。为了将目标点和终点位置重合并旋转20度，我们需要做以下几步：

1. 定义控制点：RS曲线由4个控制点P0, P1, P2, P3组成，其中P0和P3是起始和结束点，P1和P2是中间的转折点。假设目标点为P0，终点为P3，那么需要调整P1和P2的位置。

2. 确定旋转后的转折点：对于每个转折点P1，我们需要计算它的新位置，使其沿与起点P0到终点P3连线的方向逆时针旋转20度。这通常涉及到向量运算和坐标变换。

3. 更新控制点：新的转折点坐标作为新的P1和P2值，更新贝塞尔曲线的参数。

// 假设我们有原始控制点 vector<Point> controlPoints = {p0, p1, p2, p3};
Point rotateAndTranslate(Point point, Point pivot, double angle) {
    // 计算旋转后的点
    Point rotated = rotate(point - pivot, angle);
    return pivot + rotated;
}

vector<Point> updateControlPoints(vector<Point> controlPoints) {
    // 旋转转折点 P1 和 P2
    Point newP1 = rotateAndTranslate(controlPoints[1], controlPoints[0], -20); // 注意这里是负20度，因为顺时针旋转是正角度
    Point newP2 = rotateAndTranslate(controlPoints[2], controlPoints[1], -20);

    // 保持起点和终点不变
    controlPoints[0] = controlPoints[0];
    controlPoints[3] = controlPoints[3];

    // 返回新的控制点数组
    return controlPoints;
}