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