geo.cpp

//  gamma-viewer-3d - 3d visualization of sessions generated by gamma-analyzer
//  Copyright (C) 2017  Dag Robole
//
//  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, either 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 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/>.

#include "geo.h"
#include <cmath>

namespace Geo
{

QGeoCoordinate cartesianToGeodetic(const QVector3D &position)
{
    // Simplified conversion from cartesian to geodetic coordinates

    QGeoCoordinate c;

    c.setLatitude(radianToDegree<double>(
                    std::asin(position.z() / EARTH_RADIUS<double>)));

    c.setLongitude(radianToDegree<double>(
                     std::atan2(position.y(), position.x())));
    return c;
}

QVector3D geodeticToCartesian(const QGeoCoordinate &angles)
{
    // Simplified conversion from geodetic to cartesian coordinates

    QVector3D position;

    auto cosLat = std::cos(degreeToRadian<double>(angles.latitude()));
    auto sinLat = std::sin(degreeToRadian<double>(angles.latitude()));
    auto cosLon = std::cos(degreeToRadian<double>(angles.longitude()));
    auto sinLon = std::sin(degreeToRadian<double>(angles.longitude()));

    position.setX(EARTH_RADIUS<double> * cosLat * cosLon);
    position.setY(EARTH_RADIUS<double> * cosLat * sinLon);
    position.setZ(EARTH_RADIUS<double> * sinLat);

    return position;
}

} // namespace Geo