mirror of
https://github.com/OPM/ResInsight.git
synced 2025-02-25 18:55:39 -06:00
135 lines
5.2 KiB
C++
135 lines
5.2 KiB
C++
/////////////////////////////////////////////////////////////////////////////////
|
|
//
|
|
// Copyright (C) 2018- Equinor 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.
|
|
//
|
|
/////////////////////////////////////////////////////////////////////////////////
|
|
|
|
#include "RiaWellPlanCalculator.h"
|
|
#include "RiaArcCurveCalculator.h"
|
|
#include "RiaOffshoreSphericalCoords.h"
|
|
|
|
#include "cvfGeometryTools.h"
|
|
#include "cvfMatrix4.h"
|
|
|
|
//--------------------------------------------------------------------------------------------------
|
|
///
|
|
//--------------------------------------------------------------------------------------------------
|
|
RiaWellPlanCalculator::RiaWellPlanCalculator( const cvf::Vec3d& startTangent,
|
|
const std::vector<cvf::Vec3d>& lineArcEndPoints )
|
|
: m_startTangent( startTangent )
|
|
, m_lineArcEndPoints( lineArcEndPoints )
|
|
{
|
|
if ( m_lineArcEndPoints.size() < 2 ) return;
|
|
|
|
WellPlanSegment segment = { 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0 };
|
|
|
|
RiaOffshoreSphericalCoords startAziIncRad( m_startTangent );
|
|
segment.inc = cvf::Math::toDegrees( startAziIncRad.inc() );
|
|
segment.azi = cvf::Math::toDegrees( startAziIncRad.azi() );
|
|
|
|
segment.TVD = -lineArcEndPoints[0].z();
|
|
segment.NS = lineArcEndPoints[0].y();
|
|
segment.EW = lineArcEndPoints[0].x();
|
|
|
|
m_wpResult.push_back( segment );
|
|
|
|
cvf::Vec3d t2 = m_startTangent;
|
|
|
|
for ( size_t pIdx = 0; pIdx < m_lineArcEndPoints.size() - 1; ++pIdx )
|
|
{
|
|
addSegment( t2, m_lineArcEndPoints[pIdx], m_lineArcEndPoints[pIdx + 1], &t2 );
|
|
}
|
|
}
|
|
|
|
//--------------------------------------------------------------------------------------------------
|
|
///
|
|
//--------------------------------------------------------------------------------------------------
|
|
void RiaWellPlanCalculator::addSegment( cvf::Vec3d t1, cvf::Vec3d p1, cvf::Vec3d p2, cvf::Vec3d* endTangent )
|
|
{
|
|
cvf::Vec3d p1p2 = p2 - p1;
|
|
double xyLength = std::sqrt( p1p2.x() * p1p2.x() + p1p2.y() * p1p2.y() );
|
|
double zLength = std::abs( p1p2.z() );
|
|
|
|
// We only show two decimals in the well plan anyway.
|
|
if ( xyLength < 1.0e-2 && zLength < 1.0e-2 ) return;
|
|
|
|
if ( cvf::GeometryTools::getAngle( t1, p1p2 ) < 1e-5 )
|
|
{
|
|
addLineSegment( p1, p2, endTangent );
|
|
}
|
|
else // resample arc
|
|
{
|
|
addArcSegment( t1, p1, p2, endTangent );
|
|
}
|
|
}
|
|
|
|
//--------------------------------------------------------------------------------------------------
|
|
///
|
|
//--------------------------------------------------------------------------------------------------
|
|
void RiaWellPlanCalculator::addLineSegment( cvf::Vec3d p1, cvf::Vec3d p2, cvf::Vec3d* endTangent )
|
|
{
|
|
WellPlanSegment segment = { 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0 };
|
|
|
|
cvf::Vec3d p1p2 = p2 - p1;
|
|
double length = p1p2.length();
|
|
|
|
segment.CL = length;
|
|
segment.MD = m_wpResult.back().MD + length;
|
|
|
|
cvf::Vec3d tangent = p1p2 / length;
|
|
|
|
RiaOffshoreSphericalCoords aziIncRad( p1p2 );
|
|
segment.inc = cvf::Math::toDegrees( aziIncRad.inc() );
|
|
segment.azi = cvf::Math::toDegrees( aziIncRad.azi() );
|
|
|
|
segment.TVD = -p2.z();
|
|
segment.NS = p2.y();
|
|
segment.EW = p2.x();
|
|
segment.dogleg = 0.0;
|
|
segment.build = 0.0;
|
|
segment.turn = 0.0;
|
|
|
|
m_wpResult.push_back( segment );
|
|
*endTangent = tangent;
|
|
}
|
|
|
|
//--------------------------------------------------------------------------------------------------
|
|
///
|
|
//--------------------------------------------------------------------------------------------------
|
|
void RiaWellPlanCalculator::addArcSegment( cvf::Vec3d t1, cvf::Vec3d p1, cvf::Vec3d p2, cvf::Vec3d* endTangent )
|
|
{
|
|
WellPlanSegment segment = { 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0 };
|
|
|
|
RiaArcCurveCalculator arcCalc( p1, t1, p2 );
|
|
|
|
segment.CL = arcCalc.arcLength();
|
|
segment.MD = m_wpResult.back().MD + segment.CL;
|
|
segment.inc = cvf::Math::toDegrees( arcCalc.endInclination() );
|
|
segment.azi = cvf::Math::toDegrees( arcCalc.endAzimuth() );
|
|
segment.TVD = -p2.z();
|
|
segment.NS = p2.y();
|
|
segment.EW = p2.x();
|
|
segment.dogleg = cvf::Math::toDegrees( 30.0 / arcCalc.radius() );
|
|
RiaOffshoreSphericalCoords startAziIncRad( t1 );
|
|
double buildInRadsPrLength = ( arcCalc.endInclination() - startAziIncRad.inc() ) / arcCalc.arcLength();
|
|
double turnInRadsPrLength = ( arcCalc.endAzimuth() - startAziIncRad.azi() ) / arcCalc.arcLength();
|
|
segment.build = 30 * cvf::Math::toDegrees( buildInRadsPrLength );
|
|
segment.turn = 30 * cvf::Math::toDegrees( turnInRadsPrLength );
|
|
|
|
m_wpResult.push_back( segment );
|
|
|
|
( *endTangent ) = arcCalc.endTangent();
|
|
}
|