khanat-opennel-code/code/nel/src/misc/line.cpp

41 lines
1.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/>.
#include "stdmisc.h"
#include "nel/misc/line.h"
namespace NLMISC
{
void CLine::project(const CVector &inV,CVector &outV)
{
CVector seg = V1 - V0;
float n = seg.sqrnorm();
if (n == 0.f)
{
outV = V0;
}
else
{
float dp = (inV - V0) * seg;
outV = V0 + (dp / n) * seg;
}
}
} // NLMISC