public void TakeSample(Vector3D position, TimeSpan timestamp) { var sample = new PositionSample(position, timestamp); Samples.AddLast(sample); // Age out old samples while (Samples.Count > MaxSampleCount) { Samples.RemoveFirst(); } }