public void mapBackFiveSeconds()
{
var timestamp = TimeStamps.LastOrDefault().Key - TimeSpan.FromSeconds(5);
if (timestamp > TimeStamps.FirstOrDefault().Key)
{
TimeStamps = TimeStamps.Where(k => k.Key <= timestamp).ToList().ToDictionary(k => k.Key, v => v.Value);
CurMap = TimeStamps.LastOrDefault().Value;
}
}
