GPSProtocolMath.h

Go to the documentation of this file.

#pragma once
 
#include <cmath>
#include <cstdint>
#include <ctime>
#include <limits>
#include <numbers>
#include <optional>
 
#include <QtCore/QByteArray>
 
#include "GPSReceiverConfig.h"
 
namespace GPSProtocolMath {
 
inline constexpr double DEG_TO_RAD = std::numbers::pi / 180.0;
inline constexpr double RAD_TO_DEG = 180.0 / std::numbers::pi;
inline constexpr time_t UTC_PLAUSIBILITY_FLOOR_SECS = static_cast<time_t>(1234567890ULL);
 
[[nodiscard]] constexpr double degreesFromE7(int32_t value)
{
    return value * 1e-7;
}
 
[[nodiscard]] constexpr double metersFromMillimeters(int32_t value)
{
    return value / 1000.0;
}
 
[[nodiscard]] inline double roundedToMillimeters(double meters)
{
    return static_cast<double>(std::llround(meters * 1000.0)) / 1000.0;
}
 
[[nodiscard]] inline std::optional<uint32_t> tenthMillimeters(double meters)
{
    const double units = meters * 10000.0;
    if (!std::isfinite(units) || units < 0 || units > (std::numeric_limits<uint32_t>::max)()) {
        return std::nullopt;
    }
    return static_cast<uint32_t>(units);
}
 
struct Ecef
{
    double x = 0;
    double y = 0;
    double z = 0;
};
 
[[nodiscard]] Ecef toEcef(const GPSEllipsoidPosition& position);
[[nodiscard]] GPSEllipsoidPosition fromEcef(const Ecef& position);
 
[[nodiscard]] inline double distance(const Ecef& left, const Ecef& right)
{
    return std::hypot(left.x - right.x, left.y - right.y, left.z - right.z);
}
 
[[nodiscard]] bool nearEarthSurface(const Ecef& position);
 
[[nodiscard]] uint64_t utcMicroseconds(int year, int month, int day, int hour, int minute, int second, int32_t nsec);
 
}  // namespace GPSProtocolMath
 
[[nodiscard]] QByteArray gpsFixedDecimal(double value, int decimals);