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);
}