sdrangel/sdrbase/util/coordinates.h

53 wiersze
2.7 KiB
C++

///////////////////////////////////////////////////////////////////////////////////
// Copyright (C) 2022 Jon Beniston, M7RCE //
// //
// 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_COORDINATES_H
#define INCLUDE_COORDINATES_H
#include "export.h"
#include <QDateTime>
#include <QVector3D>
#include <QMatrix3x3>
#include <QMatrix4x4>
#include <QQuaternion>
// Functions for transformations between geodetic and ECEF coordinates
class SDRBASE_API Coordinates {
public:
static QVector3D geodeticToECEF(double longitude, double latitude, double height=0.0);
static QVector3D geodeticRadiansToECEF(double longitude, double latitude, double height=0.0);
static QMatrix4x4 eastNorthUpToECEF(QVector3D origin);
static void ecefToGeodetic(double x, double y, double z, double &latitude, double &longitude, double &height);
static void ecefVelToSpeedHeading(double latitude, double longitude,
double velX, double velY, double velZ,
double &speed, double &verticalRate, double &heading);
static QQuaternion orientation(double longitude, double latitude, double altitude, double heading, double pitch, double roll);
protected:
static QVector3D scaleToGeodeticSurface(QVector3D cartesian, QVector3D oneOverRadii, QVector3D oneOverRadiiSquared);
static QVector3D normalized(QVector3D vec);
static QQuaternion fromHeadingPitchRoll(double heading, double pitch, double roll);
static QQuaternion fromRotation(QMatrix3x3 mat);
};
#endif // INCLUDE_COORDINATES_H