Function GetMiddleAngle

libs/geometry/angles.cpp:35–47

}

double GetMiddleAngle(double a1, double a2)
{
  double ang = (a1 + a2) / 2.0;

  if (fabs(a1 - a2) > math::pi)
  {
    if (ang > 0.0)
      ang -= math::pi;
    else
      ang += math::pi;
  }
  return ang;
}
}  // namespace ang