khanat-opennel-code/code/nel/include/nel/misc/plane_inline.h

85 lines
2.1 KiB
C++

// NeL - MMORPG Framework <http://dev.ryzom.com/projects/nel/>
// Copyright (C) 2010 Winch Gate Property Limited
//
// This program is free software: you can redistribute it and/or modify
// it under the terms of the GNU Affero General Public License as
// published by the Free Software Foundation, either version 3 of the
// License, or (at your option) any later version.
//
// This program 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 Affero General Public License for more details.
//
// You should have received a copy of the GNU Affero General Public License
// along with this program. If not, see <http://www.gnu.org/licenses/>.
#ifndef NL_PLANE_INLINE_H
#define NL_PLANE_INLINE_H
namespace NLMISC
{
//============================================================
inline CVector CPlane::getNormal() const
{
return CVector(a,b,c);
}
//============================================================
inline float CPlane::distance(const CVector &v) const
{
CPlane p= normed();
return (float)fabs(p*v);
}
//============================================================
inline float CPlane::operator*(const CVector &p) const
{
return a*p.x + b*p.y + c*p.z + d;
}
//============================================================
inline CVector CPlane::intersect(const CVector &p0,const CVector &p1) const
{
float decal;
float da= (*this)*p0;
float db= (*this)*p1;
if(db-da == 0)
return p0;
decal= ( 0-da ) / ( db - da );
return p0 + (p1-p0)*decal;
}
//============================================================
inline CVector CPlane::project(const CVector &p0) const
{
return intersect(p0, p0+getNormal());
}
//============================================================
inline void CPlane::normalize()
{
float n= getNormal().norm();
if(n)
{
float oon= 1.0f/n;
a*= oon;
b*= oon;
c*= oon;
d*= oon;
}
}
//============================================================
inline CPlane CPlane::normed() const
{
CPlane ret= *this;
ret.normalize();
return ret;
}
}
#endif // NL_PLANE_H
/* End of plane.h */