Example #1
0
 public void CalcNextPos()
 {
     GyroAngle += _dPhiGrad;
     RotateDPhi();         // Frame(n+1) = FRame(n) rot dPhi*dt
     V.CoMultTo(dPhi);     // Vn+1 = Vn rot dPhi*dt
     Pos.AddTo(V, Par.DT); // Pos(n+1) = Pos(n) + V(n)*dt
                           // wenn rechts raus links wieder rein
     DblBuffForm.frm.CorrigatePosition(ref Pos);
 }