1
0
mirror of https://github.com/f4exb/sdrangel.git synced 2024-12-23 01:55:48 -05:00
sdrangel/sdrbase/util/azel.h

134 lines
4.1 KiB
C++

///////////////////////////////////////////////////////////////////////////////////
// Copyright (C) 2020 Jon Beniston, M7RCE <jon@beniston.com> //
// //
// This program is free software; you can redistribute it and/or modify //
// it under the terms of the GNU General Public License as published by //
// the Free Software Foundation as version 3 of the License, or //
// (at your option) any later version. //
// //
// This program is distributed in the hope that it will be useful, //
// but WITHOUT ANY WARRANTY; without even the implied warranty of //
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the //
// GNU General Public License V3 for more details. //
// //
// You should have received a copy of the GNU General Public License //
// along with this program. If not, see <http://www.gnu.org/licenses/>. //
///////////////////////////////////////////////////////////////////////////////////
#ifndef INCLUDE_AZ_EL_H
#define INCLUDE_AZ_EL_H
#include "export.h"
// Spherical coordinate
struct SDRBASE_API AzElSpherical
{
double m_latitude; // Degrees
double m_longitude; // Degrees
double m_altitude; // Metres
};
// Cartesian coordinate
struct SDRBASE_API AzElCartesian
{
double m_x; // Metres
double m_y; // Metres
double m_z; // Metres
};
struct SDRBASE_API AzElPoint
{
AzElSpherical m_spherical; // Spherical coordinates
AzElCartesian m_cart; // Cartesian coordinates
AzElCartesian m_norm; // Normal vector on surface of sphere
double m_radius; // Radius from centre of sphere to the point
};
// Class to calculate azimuth, elevation and distance between two points specified
// by latitude, longitude and altitude
// See: https://doncross.net/geocalc
class SDRBASE_API AzEl
{
public:
// Location is the point we are looking from
void setLocation(double latitude, double longitude, double altitude)
{
m_location.m_spherical.m_latitude = latitude;
m_location.m_spherical.m_longitude = longitude;
m_location.m_spherical.m_altitude = altitude;
sphericalToCartesian(m_location);
}
// Target is the point we are looking at
void setTarget(double latiude, double longitude, double altitude)
{
m_target.m_spherical.m_latitude = latiude;
m_target.m_spherical.m_longitude = longitude;
m_target.m_spherical.m_altitude = altitude;
sphericalToCartesian(m_target);
}
AzElSpherical getLocationSpherical()
{
return m_location.m_spherical;
}
AzElCartesian getLocationCartesian()
{
return m_location.m_cart;
}
AzElSpherical getTargetSpherical()
{
return m_target.m_spherical;
}
AzElCartesian getTargetCartesian()
{
return m_target.m_cart;
}
void calculate()
{
m_distance = cartDistance(m_location, m_target);
calcAzimuth();
calcElevation();
}
double getDistance()
{
return m_distance;
}
double getAzimuth()
{
return m_azimuth;
}
double getElevation()
{
return m_elevation;
}
private:
double cartDistance(const AzElPoint& a, const AzElPoint& b);
bool normVectorDiff(const AzElCartesian& a, const AzElCartesian& b, AzElCartesian& n);
double geocentricLatitude(double latRad) const;
double earthRadiusInMetres(double geodeticLatRad) const;
void sphericalToCartesian(AzElPoint& point);
void calcAzimuth();
void calcElevation();
AzElPoint m_location;
AzElPoint m_target;
double m_azimuth;
double m_elevation;
double m_distance;
};
#endif