120ca87015
git-svn-id: https://free-cad.svn.sourceforge.net/svnroot/free-cad/trunk@5000 e8eeb9e2-ec13-0410-a4a9-efa5cf37419d
115 lines
3.8 KiB
C++
115 lines
3.8 KiB
C++
// Wild Magic Source Code
|
|
// David Eberly
|
|
// http://www.geometrictools.com
|
|
// Copyright (c) 1998-2007
|
|
//
|
|
// This library is free software; you can redistribute it and/or modify it
|
|
// under the terms of the GNU Lesser General Public License as published by
|
|
// the Free Software Foundation; either version 2.1 of the License, or (at
|
|
// your option) any later version. The license is available for reading at
|
|
// either of the locations:
|
|
// http://www.gnu.org/copyleft/lgpl.html
|
|
// http://www.geometrictools.com/License/WildMagicLicense.pdf
|
|
// The license applies to versions 0 through 4 of Wild Magic.
|
|
//
|
|
// Version: 4.0.0 (2006/06/28)
|
|
|
|
#include "Wm4FoundationPCH.h"
|
|
#include "Wm4IntrLine3Plane3.h"
|
|
|
|
namespace Wm4
|
|
{
|
|
//----------------------------------------------------------------------------
|
|
template <class Real>
|
|
IntrLine3Plane3<Real>::IntrLine3Plane3 (const Line3<Real>& rkLine,
|
|
const Plane3<Real>& rkPlane)
|
|
:
|
|
m_rkLine(rkLine),
|
|
m_rkPlane(rkPlane)
|
|
{
|
|
}
|
|
//----------------------------------------------------------------------------
|
|
template <class Real>
|
|
const Line3<Real>& IntrLine3Plane3<Real>::GetLine () const
|
|
{
|
|
return m_rkLine;
|
|
}
|
|
//----------------------------------------------------------------------------
|
|
template <class Real>
|
|
const Plane3<Real>& IntrLine3Plane3<Real>::GetPlane () const
|
|
{
|
|
return m_rkPlane;
|
|
}
|
|
//----------------------------------------------------------------------------
|
|
template <class Real>
|
|
bool IntrLine3Plane3<Real>::Test ()
|
|
{
|
|
Real fDdN = m_rkLine.Direction.Dot(m_rkPlane.Normal);
|
|
if (Math<Real>::FAbs(fDdN) > Math<Real>::ZERO_TOLERANCE)
|
|
{
|
|
// The line is not parallel to the plane, so they must intersect.
|
|
// The line parameter is *not* set, since this is a test-intersection
|
|
// query.
|
|
m_iIntersectionType = IT_POINT;
|
|
return true;
|
|
}
|
|
|
|
// The line and plane are parallel. Determine if they are numerically
|
|
// close enough to be coincident.
|
|
Real fSDistance = m_rkPlane.DistanceTo(m_rkLine.Origin);
|
|
if (Math<Real>::FAbs(fSDistance) <= Math<Real>::ZERO_TOLERANCE)
|
|
{
|
|
m_iIntersectionType = IT_LINE;
|
|
return true;
|
|
}
|
|
|
|
m_iIntersectionType = IT_EMPTY;
|
|
return false;
|
|
}
|
|
//----------------------------------------------------------------------------
|
|
template <class Real>
|
|
bool IntrLine3Plane3<Real>::Find ()
|
|
{
|
|
Real fDdN = m_rkLine.Direction.Dot(m_rkPlane.Normal);
|
|
Real fSDistance = m_rkPlane.DistanceTo(m_rkLine.Origin);
|
|
if (Math<Real>::FAbs(fDdN) > Math<Real>::ZERO_TOLERANCE)
|
|
{
|
|
// The line is not parallel to the plane, so they must intersect.
|
|
m_fLineT = -fSDistance/fDdN;
|
|
m_iIntersectionType = IT_POINT;
|
|
return true;
|
|
}
|
|
|
|
// The Line and plane are parallel. Determine if they are numerically
|
|
// close enough to be coincident.
|
|
if (Math<Real>::FAbs(fSDistance) <= Math<Real>::ZERO_TOLERANCE)
|
|
{
|
|
// The line is coincident with the plane, so choose t = 0 for the
|
|
// parameter.
|
|
m_fLineT = (Real)0.0;
|
|
m_iIntersectionType = IT_LINE;
|
|
return true;
|
|
}
|
|
|
|
m_iIntersectionType = IT_EMPTY;
|
|
return false;
|
|
}
|
|
//----------------------------------------------------------------------------
|
|
template <class Real>
|
|
Real IntrLine3Plane3<Real>::GetLineT () const
|
|
{
|
|
return m_fLineT;
|
|
}
|
|
//----------------------------------------------------------------------------
|
|
|
|
//----------------------------------------------------------------------------
|
|
// explicit instantiation
|
|
//----------------------------------------------------------------------------
|
|
template WM4_FOUNDATION_ITEM
|
|
class IntrLine3Plane3<float>;
|
|
|
|
template WM4_FOUNDATION_ITEM
|
|
class IntrLine3Plane3<double>;
|
|
//----------------------------------------------------------------------------
|
|
}
|