wrap.hpp

Go to the documentation of this file.

#pragma once
 
#include <cmath>
 
#include "NumCpp/Core/Constants.hpp"
#include "NumCpp/Core/Internal/StaticAsserts.hpp"
#include "NumCpp/Core/Internal/StlAlgorithms.hpp"
 
namespace nc
{
    template<typename dtype>
    double wrap(dtype inAngle) noexcept
    {
        STATIC_ASSERT_ARITHMETIC(dtype);
 
        auto angle = std::fmod(static_cast<double>(inAngle) + constants::pi, constants::twoPi);
        if (angle < 0.)
        {
            angle += constants::twoPi;
        }
 
        return angle - constants::pi;
    }

    template<typename dtype>
    NdArray<double> wrap(const NdArray<dtype>& inAngles) noexcept
    {
        NdArray<double> returnArray(inAngles.size());
        stl_algorithms::transform(inAngles.begin(),
                                  inAngles.end(),
                                  returnArray.begin(),
                                  [](const auto angle) noexcept -> double { return wrap(angle); });
        return returnArray;
    }
} // namespace nc