public void Update()
{
UpdateSegment();
//EstX += Vx; EstY += Vy;
Trajectory.Enqueue(new PointF((float)X, (float)Y));
if (Trajectory.Count > 100)
{
Trajectory.Dequeue();
}
//EstimationTrajectory.Enqueue(new PointF((float)(InitX + EstX), (float)(InitY + EstY)));
//if (EstimationTrajectory.Count > 100)
//{
// EstimationTrajectory.Dequeue();
//}
}