weightedBearing static method

double weightedBearing(
  1. double gpsBearing,
  2. double roadBearing,
  3. double confidence
)

E6: Weighted Bearing

Implementation

static double weightedBearing(
  double gpsBearing,
  double roadBearing,
  double confidence,
) {
  double diff = roadBearing - gpsBearing;
  while (diff > 180) {
    diff -= 360;
  }
  while (diff < -180) {
    diff += 360;
  }
  return (gpsBearing + diff * confidence + 360) % 360;
}