Units.hpp

// This file is part of INSTINCT, the INS Toolkit for Integrated
// Navigation Concepts and Training by the Institute of Navigation of
// the University of Stuttgart, Germany.
//
// This Source Code Form is subject to the terms of the Mozilla Public
// License, v. 2.0. If a copy of the MPL was not distributed with this
// file, You can obtain one at https://mozilla.org/MPL/2.0/.
 
#pragma once
 
#include <numbers>
#include <Eigen/Core>
 
namespace NAV
{
 
template<class T>
[[nodiscard]] constexpr auto deg2rad(const T& deg)
{
    return deg * std::numbers::pi_v<double> / 180.0;
}
 
template<typename Scalar>
[[nodiscard]] inline Eigen::Vector3<Scalar> deg2rad(const Eigen::Vector3<Scalar>& deg)
{
    return deg * std::numbers::pi_v<Scalar> / 180.0;
}
 
template<class T>
[[nodiscard]] constexpr auto rad2deg(const T& rad)
{
    return rad * 180.0 / std::numbers::pi_v<double>;
}
 
template<typename Scalar>
[[nodiscard]] inline Eigen::Vector3<Scalar> rad2deg(const Eigen::Vector3<Scalar>& rad)
{
    return rad * 180.0 / std::numbers::pi_v<Scalar>;
}
 
template<class T>
[[nodiscard]] constexpr auto semicircles2rad(const T& semicircles)
{
    return semicircles * std::numbers::pi_v<double>;
}
 
template<class T>
[[nodiscard]] constexpr auto rad2semicircles(const T& rad)
{
    return rad / std::numbers::pi_v<double>;
}
 
constexpr long double operator"" _deg(long double deg)
{
    return deg2rad(deg);
}
 
constexpr long double operator"" _mas(long double mas)
{
    return mas * std::numbers::pi_v<long double> / 648000000.0L;
}
 
constexpr long double operator"" _mas(unsigned long long mas) // NOLINT(google-runtime-int)
{
    return static_cast<long double>(mas) * std::numbers::pi_v<long double> / 648000000.0L;
}
 
constexpr long double operator"" _ppb(long double ppb)
{
    return ppb * 1e-9L;
}
 
constexpr long double operator"" _ppb(unsigned long long ppb) // NOLINT(google-runtime-int)
{
    return static_cast<long double>(ppb) * 1e-9L;
}
 
} // namespace NAV