public double CalculateAngle(GpsInfo current) { //return current.AngleDegrees; foreach (var gps in CarSignalSet.Where(x => x.IsGpsValid).Select(x => x.Gps)) { var distance = GeoHelper.GetDistanceFast(current.LongitudeDegrees, current.LatitudeDegrees, gps.LongitudeDegrees, gps.LatitudeDegrees); if (distance > 0.5) { var angle = GeoHelper.GetBearing(gps.LongitudeDegrees, gps.LatitudeDegrees, current.LongitudeDegrees, current.LatitudeDegrees); return(angle); } } return(double.NaN); }