两个点围绕相同的中心旋转但距离增加

时间:2012-10-18 12:22:27

标签: c++ rotation trigonometry

我想实现两点相互转动。因此我使用旋转矩阵。但是我现在遇到的问题是点之间的距离正在增长(参见上面的视频1)。然而,距离应该在整个模拟过程中保持不变。

这是我用来计算速度的代码:

其中p1和p2是两点。

double xPos = p0.x+p1.x;
double yPos = p0.y+p1.y;
//The center between p1 and p2
xPos /=2;
yPos /=2;
//the rotating angle
double omega = 0.1;
//calculate the new positions
double x0new = xPos + (p0.x-xPos)*std::cos(omega) - (p0.y-yPos)*std::sin(omega);
double y0new = yPos + (p0.x-xPos)*std::sin(omega) + (p0.y-yPos)*std::cos(omega);
double x1new = xPos + (p1.x-xPos)*std::cos(omega) - (p1.y-yPos)*std::sin(omega);
double y1new = yPos + (p1.x-xPos)*std::sin(omega) + (p1.y-yPos)*std::cos(omega);
//the speed is exatly the difference as I integrate one timestep
p0.setSpeed(p0.x-x0new, p0.y-y0new);
p1.setSpeed(p1.x-x1new, p1.y-y1new);

然后我将速度恰好整合一次。我的计算有什么问题?

更新 的 看来我的整合是错误的。如果我直接设置位置,那就完美了。但是我现在不知道这种集成有什么问题:

setSpeed(ux,uy){
     ux_=ux;
     uy_=uy;
}
// integrate one timestep t = 1
move(){
     x = x + ux_;
     y = y + uy_;
}

Video of my behaviour

2 个答案:

答案 0 :(得分:1)

乍一看,主要原因是您在每次迭代中更新p0p1坐标。这会累积不准确,可能来自setSpeed

相反,您应该使用常量初始坐标p0p1,但增加omega角度。

答案 1 :(得分:1)

此代码中没有任何明显的错误,但未显示的“速度”积分表明您可能在新旧位置之间线性积分,这将使速度>时的轨道扩展。标称速度并在速度<1时收缩。 nominal_speed。

我怀疑。积分实际上是在点p0和p1之间的线段处的外推,它们应该与原点保持固定距离(物理模拟可能会使轨迹椭圆...)

因此,如果外推因子为0,则新位置将在计算的周长上。如果是&lt; 0(和&gt; -1),您将在预期轨迹内插值。

         O     This beautiful ascii art is trying to illustrate the integration
        /      x is the original position, o is the new one and O is the 
       / ___-----   "integrated" value and the arc is a perfect circle :)
      o--      Only at the calculated position o, there is no expansion.
   --/
  / /
 / /
| /
x