wmlintrpln3cap3.cpp

3D Game Engine Design Source Code非常棒

// Magic Software, Inc.
// http://www.magic-software.com
// Copyright (c) 2000-2003.  All Rights Reserved
//
// Source code from Magic Software is supplied under the terms of a license
// agreement and may not be copied or disclosed except in accordance with the
// terms of that agreement.  The various license agreements may be found at
// the Magic Software web site.  This file is subject to the license
//
// FREE SOURCE CODE
// http://www.magic-software.com/License/free.pdf

#include "WmlIntrPln3Cap3.h"
using namespace Wml;

//----------------------------------------------------------------------------
template <class Real>
bool Wml::TestIntersection (const Plane3<Real>& rkPlane,
    const Capsule3<Real>& rkCapsule, bool bUnitNormal)
{
    Vector3<Real> kNormal = rkPlane.GetNormal();
    Real fConstant = rkPlane.GetConstant();
    if ( !bUnitNormal )
    {
        Real fLength = kNormal.Normalize();
        fConstant /= fLength;
    }

    Real fTmp0 = kNormal.Dot(rkCapsule.Origin()) - fConstant;
    Real fTmp1 = fTmp0 + kNormal.Dot(rkCapsule.Direction());
    if ( fTmp0*fTmp1 <= (Real)0.0 )
    {
        // capsule ends on opposite sides of the plane
        return true;
    }
    else
    {
        return Math<Real>::FAbs(fTmp0) <= rkCapsule.Radius()
            || Math<Real>::FAbs(fTmp1) <= rkCapsule.Radius();
    }
}
//----------------------------------------------------------------------------
template <class Real>
bool Wml::Culled (const Plane3<Real>& rkPlane,
    const Capsule3<Real>& rkCapsule, bool bUnitNormal)
{
    Vector3<Real> kNormal = rkPlane.GetNormal();
    Real fConstant = rkPlane.GetConstant();
    if ( !bUnitNormal )
    {
        Real fLength = kNormal.Normalize();
        fConstant /= fLength;
    }

    Real fTmp0 = kNormal.Dot(rkCapsule.Origin()) - fConstant;
    if ( fTmp0 < (Real)0.0 )
    {
        Real fTmp1 = fTmp0 + kNormal.Dot(rkCapsule.Direction());
        if ( fTmp1 < (Real)0.0 )
        {
            if ( fTmp0 <= fTmp1 )
                return fTmp0 <= -rkCapsule.Radius();
            else
                return fTmp1 <= -rkCapsule.Radius();
        }
    }

    return false;
}
//----------------------------------------------------------------------------

//----------------------------------------------------------------------------
// explicit instantiation
//----------------------------------------------------------------------------
namespace Wml
{
template WML_ITEM bool TestIntersection<float> (const Plane3<float>&,
    const Capsule3<float>&, bool);
template WML_ITEM bool Culled<float> (const Plane3<float>&,
    const Capsule3<float>&, bool);

template WML_ITEM bool TestIntersection<double> (const Plane3<double>&,
    const Capsule3<double>&, bool);
template WML_ITEM bool Culled<double> (const Plane3<double>&,
    const Capsule3<double>&, bool);
}
//----------------------------------------------------------------------------