Angle.h

/**************************************************************************
 * basf2 (Belle II Analysis Software Framework)                           *
 * Author: The Belle II Collaboration                                     *
 *                                                                        *
 * See git log for contributors and copyright holders.                    *
 * This file is licensed under LGPL-3.0, see LICENSE.md.                  *
 **************************************************************************/
#pragma once
 
#include <cmath>
 
namespace Belle2 {
  namespace TrackFindingCDC {
 
 
    struct AngleUtil {
 
      static double average(const double angle1, double angle2)
      {
        return normalised(angle1 + normalised(angle2 - angle1) / 2);
      }
 
      static double normalised(const double angle)
      {
        if (angle > M_PI) return angle - 2 * M_PI;
        if (angle < -M_PI) return angle + 2 * M_PI;
        return angle;
      }
 
      static void normalise(double& angle)
      {
        if (angle > M_PI) angle -= 2 * M_PI;
        if (angle < -M_PI) angle += 2 * M_PI;
      }
 
      static double fullNormalised(const double angle)
      {
        return std::remainder(angle, 2 * M_PI);
      }
 
      static double reversed(const double angle)
      {
        return angle > 0 ? angle - M_PI : angle + M_PI;
      }
 
    };
 
  }
}