Dario Sassi
162 lines
4.7 KiB
C++
162 lines
4.7 KiB
C++
//----------------------------------------------------------------------------
|
|
// EgalTech 2013-2013
|
|
//----------------------------------------------------------------------------
|
|
// File : DistPointArc.cpp Data : 28.12.13 Versione : 1.4l5
|
|
// Contenuto : Implementazione della classe distanza punto da circonferenza/arco.
|
|
//
|
|
//
|
|
//
|
|
// Modifiche : 28.12.13 DS Creazione modulo.
|
|
//
|
|
//
|
|
//----------------------------------------------------------------------------
|
|
|
|
//--------------------------- Include ----------------------------------------
|
|
#include "stdafx.h"
|
|
#include "DistPointArc.h"
|
|
|
|
|
|
//----------------------------------------------------------------------------
|
|
DistPointArc::DistPointArc( const Point3d& ptP, const ICurveArc& arArc)
|
|
{
|
|
// distanza non calcolata
|
|
m_dDist = - 1 ;
|
|
|
|
if ( ! arArc.IsValid())
|
|
return ;
|
|
|
|
// se circonferenza
|
|
if ( arArc.IsACircle())
|
|
DistPointCircle( ptP, arArc) ;
|
|
|
|
// se arco in un piano
|
|
else if ( arArc.IsFlat())
|
|
DistPointFlatArc( ptP, arArc) ;
|
|
|
|
// altrimenti caso generico
|
|
else
|
|
DistPointHelix( ptP, arArc) ;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------
|
|
void
|
|
DistPointArc::DistPointCircle( const Point3d& ptP, const ICurveArc& arArc)
|
|
{
|
|
// vettori ausiliari
|
|
Vector3d vtDiff = ptP - arArc.GetCenter() ;
|
|
double dDistN = vtDiff * arArc.GetNormVersor() ;
|
|
Vector3d vtDiffPlane = vtDiff - dDistN * arArc.GetNormVersor() ;
|
|
double dDistPlane = fabs( vtDiffPlane.Len() - arArc.GetRadius()) ;
|
|
// calcolo della distanza
|
|
if ( fabs( dDistPlane) > EPS_ZERO && fabs( dDistN) > EPS_ZERO)
|
|
m_dDist = sqrt( dDistPlane * dDistPlane + dDistN * dDistN) ;
|
|
else if ( fabs( dDistPlane) > EPS_ZERO)
|
|
m_dDist = dDistPlane ;
|
|
else if ( fabs( dDistN) > EPS_ZERO)
|
|
m_dDist = fabs( dDistN) ;
|
|
else
|
|
m_dDist = 0 ;
|
|
// calcolo del parametro del punto a minima distanza
|
|
if ( vtDiffPlane.Normalize()) {
|
|
bool bDet ;
|
|
double dAngDeg ;
|
|
arArc.GetStartVersor().GetRotation( vtDiffPlane, arArc.GetNormVersor(), dAngDeg, bDet) ;
|
|
if ( arArc.GetAngCenter() > 0 && dAngDeg < 0)
|
|
dAngDeg += 360 ;
|
|
else if ( arArc.GetAngCenter() < 0 && dAngDeg > 0)
|
|
dAngDeg -= 360 ;
|
|
m_dParam = dAngDeg / arArc.GetAngCenter() ;
|
|
if ( m_dParam < 0)
|
|
m_dParam = 0 ;
|
|
else if ( m_dParam > 1)
|
|
m_dParam = 1 ;
|
|
m_bDet = true ;
|
|
}
|
|
else {
|
|
// tutti i punti della circonferenza sono a minima distanza, imposto il punto medio
|
|
m_dParam = 0.5 ;
|
|
m_bDet = false ;
|
|
}
|
|
// calcolo del punto di minima distanza
|
|
arArc.GetPointD1D2( m_dParam, ICurve::FROM_MINUS, m_ptMinDist) ;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------
|
|
void
|
|
DistPointArc::DistPointFlatArc( const Point3d& ptP, const ICurveArc& arArc)
|
|
{
|
|
// calcolo come per il cerchio (ma angolo al centro corretto)
|
|
DistPointCircle( ptP, arArc) ;
|
|
|
|
// se il parametro è sui bordi, verifico quale dei due
|
|
if ( fabs( m_dParam) < EPS_ZERO || fabs( m_dParam - 1) < EPS_ZERO) {
|
|
Point3d ptTest ;
|
|
m_dDist = INFINITO ;
|
|
for ( int i = 0 ; i <= 1 ; i ++) {
|
|
double dU = i ;
|
|
arArc.GetPointD1D2( dU, ICurve::FROM_MINUS, ptTest) ;
|
|
double dSqDist = SqDist( ptP, ptTest) ;
|
|
if ( dSqDist < m_dDist * m_dDist) {
|
|
m_dDist = sqrt( dSqDist) ;
|
|
m_dParam = dU ;
|
|
m_ptMinDist = ptTest ;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
//----------------------------------------------------------------------------
|
|
void
|
|
DistPointArc::DistPointHelix( const Point3d& ptP, const ICurveArc& arArc)
|
|
{
|
|
|
|
}
|
|
|
|
//----------------------------------------------------------------------------
|
|
bool
|
|
DistPointArc::GetSqDist( double& dSqDist)
|
|
{
|
|
if ( m_dDist < 0)
|
|
return false ;
|
|
|
|
dSqDist = m_dDist * m_dDist ;
|
|
return true ;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------
|
|
bool
|
|
DistPointArc::GetDist( double& dDist)
|
|
{
|
|
if ( m_dDist < 0)
|
|
return false ;
|
|
|
|
dDist = m_dDist ;
|
|
return true ;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------
|
|
bool
|
|
DistPointArc::GetPointMinDist( Point3d& ptMinDist, bool* pbDet)
|
|
{
|
|
if ( m_dDist < 0)
|
|
return false ;
|
|
|
|
ptMinDist = m_ptMinDist ;
|
|
if ( pbDet != nullptr)
|
|
*pbDet = m_bDet ;
|
|
return true ;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------
|
|
bool
|
|
DistPointArc::GetParamAtPointMinDist( double& dParam, bool* pbDet)
|
|
{
|
|
if ( m_dDist < 0)
|
|
return false ;
|
|
|
|
dParam = m_dParam ;
|
|
if ( pbDet != nullptr)
|
|
*pbDet = m_bDet ;
|
|
return true ;
|
|
}
|