Angle.h

/**************************************************************************
 * BASF2 (Belle Analysis Framework 2)                                     *
 * Copyright(C) 2015 - Belle II Collaboration                             *
 *                                                                        *
 * Author: The Belle II Collaboration                                     *
 * Contributors: Oliver Frost                                             *
 *                                                                        *
 * This software is provided "as is" without any warranty.                *
 **************************************************************************/
#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;
      }
 
    };
 
  }
}