Angle.hpp

Go to the documentation of this file.

/*
 * ----------------- BEGIN LICENSE BLOCK ---------------------------------
 *
 * Copyright (C) 2018-2020 Intel Corporation
 *
 * SPDX-License-Identifier: MIT
 *
 * ----------------- END LICENSE BLOCK -----------------------------------
 */
 
#pragma once
 
#include <cmath>
#include <iostream>
#include <limits>
#include <sstream>
#include <stdexcept>
#include "spdlog/fmt/ostr.h"
#include "spdlog/spdlog.h"
namespace ad {
namespace physics {
 
#define AD_PHYSICS_ANGLE_THROWS_EXCEPTION 1
 
#if SAFE_DATATYPES_EXPLICIT_CONVERSION
 
#define _AD_PHYSICS_ANGLE_EXPLICIT_CONVERSION_ explicit
#else
 
#define _AD_PHYSICS_ANGLE_EXPLICIT_CONVERSION_
#endif
 
class Angle
{
public:
  static const double cMinValue;
 
  static const double cMaxValue;
 
  static const double cPrecisionValue;
 
  Angle()
    : mAngle(std::numeric_limits<double>::quiet_NaN())
  {
  }
 
  _AD_PHYSICS_ANGLE_EXPLICIT_CONVERSION_ Angle(double const iAngle)
    : mAngle(iAngle)
  {
  }
 
  Angle(const Angle &other) = default;
 
  Angle(Angle &&other) = default;
 
  Angle &operator=(const Angle &other) = default;
 
  Angle &operator=(Angle &&other) = default;
 
  bool operator==(const Angle &other) const
  {
    ensureValid();
    other.ensureValid();
    return std::fabs(mAngle - other.mAngle) < cPrecisionValue;
  }
 
  bool operator!=(const Angle &other) const
  {
    return !operator==(other);
  }
 
  bool operator>(const Angle &other) const
  {
    ensureValid();
    other.ensureValid();
    return (mAngle > other.mAngle) && operator!=(other);
  }
 
  bool operator<(const Angle &other) const
  {
    ensureValid();
    other.ensureValid();
    return (mAngle < other.mAngle) && operator!=(other);
  }
 
  bool operator>=(const Angle &other) const
  {
    ensureValid();
    other.ensureValid();
    return ((mAngle > other.mAngle) || operator==(other));
  }
 
  bool operator<=(const Angle &other) const
  {
    ensureValid();
    other.ensureValid();
    return ((mAngle < other.mAngle) || operator==(other));
  }
 
  Angle operator+(const Angle &other) const
  {
    ensureValid();
    other.ensureValid();
    Angle const result(mAngle + other.mAngle);
    result.ensureValid();
    return result;
  }
 
  Angle &operator+=(const Angle &other)
  {
    ensureValid();
    other.ensureValid();
    mAngle += other.mAngle;
    ensureValid();
    return *this;
  }
 
  Angle operator-(const Angle &other) const
  {
    ensureValid();
    other.ensureValid();
    Angle const result(mAngle - other.mAngle);
    result.ensureValid();
    return result;
  }
 
  Angle operator-=(const Angle &other)
  {
    ensureValid();
    other.ensureValid();
    mAngle -= other.mAngle;
    ensureValid();
    return *this;
  }
 
  Angle operator*(const double &scalar) const
  {
    ensureValid();
    Angle const result(mAngle * scalar);
    result.ensureValid();
    return result;
  }
 
  Angle operator/(const double &scalar) const
  {
    Angle const scalarAngle(scalar);
    Angle const result(operator/(scalarAngle));
    result.ensureValid();
    return result;
  }
 
  double operator/(const Angle &other) const
  {
    ensureValid();
    other.ensureValidNonZero();
    double const result = mAngle / other.mAngle;
    return result;
  }
 
  Angle operator-() const
  {
    ensureValid();
    Angle const result(-mAngle);
    result.ensureValid(); // LCOV_EXCL_BR_LINE Some types do not throw an exception
    return result;
  }
 
  _AD_PHYSICS_ANGLE_EXPLICIT_CONVERSION_ operator double() const
  {
    return mAngle;
  }
 
  bool isValid() const
  {
    auto const valueClass = std::fpclassify(mAngle);
    return ((valueClass == FP_NORMAL) || (valueClass == FP_ZERO)) && (cMinValue <= mAngle) && (mAngle <= cMaxValue);
  }
 
  void ensureValid() const
  {
    if (!isValid())
    {
      spdlog::info("ensureValid(::ad::physics::Angle)>> {} value out of range", *this); // LCOV_EXCL_BR_LINE
#if (AD_PHYSICS_ANGLE_THROWS_EXCEPTION == 1)
      throw std::out_of_range("Angle value out of range"); // LCOV_EXCL_BR_LINE
#endif
    }
  }
 
  void ensureValidNonZero() const
  {
    ensureValid();
    if (operator==(Angle(0.))) // LCOV_EXCL_BR_LINE
    {
      spdlog::info("ensureValid(::ad::physics::Angle)>> {} value is zero", *this); // LCOV_EXCL_BR_LINE
#if (AD_PHYSICS_ANGLE_THROWS_EXCEPTION == 1)
      throw std::out_of_range("Angle value is zero"); // LCOV_EXCL_BR_LINE
#endif
    }
  }
 
  static Angle getMin()
  {
    return Angle(cMinValue);
  }
 
  static Angle getMax()
  {
    return Angle(cMaxValue);
  }
 
  static Angle getPrecision()
  {
    return Angle(cPrecisionValue);
  }
 
private:
  double mAngle;
};
 
} // namespace physics
} // namespace ad
inline ::ad::physics::Angle operator*(const double &other, ::ad::physics::Angle const &value)
{
  return value.operator*(other);
}
 
namespace std {
 
inline ::ad::physics::Angle fabs(const ::ad::physics::Angle other)
{
  ::ad::physics::Angle const result(std::fabs(static_cast<double>(other)));
  return result;
}
 
template <> class numeric_limits<::ad::physics::Angle> : public numeric_limits<double>
{
public:
  static inline ::ad::physics::Angle lowest()
  {
    return ::ad::physics::Angle::getMin();
  }
  static inline ::ad::physics::Angle max()
  {
    return ::ad::physics::Angle::getMax();
  }
 
  static inline ::ad::physics::Angle epsilon()
  {
    return ::ad::physics::Angle::getPrecision();
  }
};
 
} // namespace std
 
#ifndef GEN_GUARD_AD_PHYSICS_ANGLE
#define GEN_GUARD_AD_PHYSICS_ANGLE
 
namespace ad {
namespace physics {
 
inline std::ostream &operator<<(std::ostream &os, Angle const &_value)
{
  return os << double(_value);
}
 
} // namespace physics
} // namespace ad
 
namespace std {
inline std::string to_string(::ad::physics::Angle const &value)
{
  return to_string(static_cast<double>(value));
}
} // namespace std
#endif // GEN_GUARD_AD_PHYSICS_ANGLE