NEDtoAER.hpp

Go to the documentation of this file.

 
#pragma once
 
#include <cmath>
 
#include "NumCpp/Coordinates/ReferenceFrames/AER.hpp"
#include "NumCpp/Coordinates/ReferenceFrames/NED.hpp"
#include "NumCpp/Functions/wrap2Pi.hpp"
 
namespace nc::coordinates::transforms
{
    [[nodiscard]] inline reference_frames::AER NEDtoAER(const reference_frames::NED& target) noexcept
    {
        const auto hypotXy = std::hypot(target.x, target.y);
        const auto el      = -std::atan2(target.z, hypotXy);
        const auto az      = wrap2Pi(std::atan2(target.y, target.x));
        const auto r       = std::hypot(target.x, target.y);
        const auto range   = std::hypot(r, target.z);
        return { az, el, range };
    }
} // namespace nc::coordinates::transforms