mirror of
https://github.com/OPM/ResInsight.git
synced 2025-02-14 17:44:20 -06:00
79 lines
2.7 KiB
C++
79 lines
2.7 KiB
C++
/////////////////////////////////////////////////////////////////////////////////
|
|
//
|
|
// Copyright (C) 2018- Statoil ASA
|
|
//
|
|
// ResInsight 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.
|
|
//
|
|
// ResInsight 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 at <http://www.gnu.org/licenses/gpl.html>
|
|
// for more details.
|
|
//
|
|
/////////////////////////////////////////////////////////////////////////////////
|
|
#pragma once
|
|
|
|
#include <array>
|
|
#include "cvfVector3.h"
|
|
#include <cmath>
|
|
|
|
// Y - North, X - East, Z - up but depth is negative Z
|
|
// azi is measured from the Northing (Y) Axis in Clockwise direction looking down
|
|
// inc is measured from the negative Z (depth) axis
|
|
|
|
const double singularityEpsilon = 1.0e-5;
|
|
|
|
class RiaOffshoreSphericalCoords
|
|
{
|
|
public:
|
|
explicit RiaOffshoreSphericalCoords(const cvf::Vec3f& vec)
|
|
{
|
|
// Azimuth:
|
|
if ( fabs(vec[0]) < singularityEpsilon && fabs(vec[1]) < singularityEpsilon ) incAziR[1] = 0.0f;
|
|
else incAziR[1] = atan2(vec[0], vec[1]); // atan2(Y, X)
|
|
|
|
// R
|
|
incAziR[2] = vec.length();
|
|
|
|
// Inclination from vertical down
|
|
if (fabs( incAziR[2]) < singularityEpsilon) incAziR[0] = 0.0f;
|
|
else incAziR[0] = acos(-vec[2]/incAziR[2]);
|
|
|
|
}
|
|
|
|
explicit RiaOffshoreSphericalCoords(const cvf::Vec3d& vec)
|
|
{
|
|
// Azimuth:
|
|
if (fabs(vec[0]) < singularityEpsilon && fabs(vec[1]) < singularityEpsilon ) incAziR[1] = 0.0;
|
|
else incAziR[1] = atan2(vec[0], vec[1]); // atan2(Y, X)
|
|
|
|
// R
|
|
incAziR[2] = vec.length();
|
|
|
|
// Inclination from vertical down
|
|
if (fabs( incAziR[2]) < singularityEpsilon) incAziR[0] = 0.0;
|
|
else incAziR[0] = acos(-vec[2]/incAziR[2]);
|
|
|
|
}
|
|
double inc() const { return incAziR[0];}
|
|
double azi() const { return incAziR[1];}
|
|
double r() const { return incAziR[2];}
|
|
|
|
// Note that this is a double function, while the rest of the class is float.
|
|
// Todo: Convert class to a template to enable float and double versions of everything
|
|
static cvf::Vec3d unitVectorFromAziInc(double azimuth, double inclination)
|
|
{
|
|
return cvf::Vec3d(sin(azimuth)*sin(inclination),
|
|
cos(azimuth)*sin(inclination),
|
|
-cos(inclination));
|
|
}
|
|
|
|
private:
|
|
std::array<double, 3> incAziR;
|
|
};
|
|
|