137 lines
4.3 KiB
C++
137 lines
4.3 KiB
C++
/*************************************************************************
|
|
*
|
|
* $RCSfile: b3dvector.cxx,v $
|
|
*
|
|
* $Revision: 1.5 $
|
|
*
|
|
* last change: $Author: aw $ $Date: 2004-01-16 14:30:10 $
|
|
*
|
|
* The Contents of this file are made available subject to the terms of
|
|
* either of the following licenses
|
|
*
|
|
* - GNU Lesser General Public License Version 2.1
|
|
* - Sun Industry Standards Source License Version 1.1
|
|
*
|
|
* Sun Microsystems Inc., October, 2000
|
|
*
|
|
* GNU Lesser General Public License Version 2.1
|
|
* =============================================
|
|
* Copyright 2000 by Sun Microsystems, Inc.
|
|
* 901 San Antonio Road, Palo Alto, CA 94303, USA
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
* License version 2.1, as published by the Free Software Foundation.
|
|
*
|
|
* This library 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
|
|
* Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
* License along with this library; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|
* MA 02111-1307 USA
|
|
*
|
|
*
|
|
* Sun Industry Standards Source License Version 1.1
|
|
* =================================================
|
|
* The contents of this file are subject to the Sun Industry Standards
|
|
* Source License Version 1.1 (the "License"); You may not use this file
|
|
* except in compliance with the License. You may obtain a copy of the
|
|
* License at http://www.openoffice.org/license.html.
|
|
*
|
|
* Software provided under this License is provided on an "AS IS" basis,
|
|
* WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESSED OR IMPLIED, INCLUDING,
|
|
* WITHOUT LIMITATION, WARRANTIES THAT THE SOFTWARE IS FREE OF DEFECTS,
|
|
* MERCHANTABLE, FIT FOR A PARTICULAR PURPOSE, OR NON-INFRINGING.
|
|
* See the License for the specific provisions governing your rights and
|
|
* obligations concerning the Software.
|
|
*
|
|
* The Initial Developer of the Original Code is: Sun Microsystems, Inc.
|
|
*
|
|
* Copyright: 2000 by Sun Microsystems, Inc.
|
|
*
|
|
* All Rights Reserved.
|
|
*
|
|
* Contributor(s): _______________________________________
|
|
*
|
|
*
|
|
************************************************************************/
|
|
|
|
#ifndef _BGFX_VECTOR_B3DVECTOR_HXX
|
|
#include <basegfx/vector/b3dvector.hxx>
|
|
#endif
|
|
|
|
#ifndef _BGFX_MATRIX_B3DHOMMATRIX_HXX
|
|
#include <basegfx/matrix/b3dhommatrix.hxx>
|
|
#endif
|
|
|
|
namespace basegfx
|
|
{
|
|
B3DVector& B3DVector::normalize()
|
|
{
|
|
double fLen(scalar(*this));
|
|
|
|
if(!::basegfx::fTools::equalZero(fLen))
|
|
{
|
|
const double fOne(1.0);
|
|
|
|
if(!::basegfx::fTools::equal(fOne, fLen))
|
|
{
|
|
fLen = sqrt(fLen);
|
|
|
|
if(!::basegfx::fTools::equalZero(fLen))
|
|
{
|
|
mfX /= fLen;
|
|
mfY /= fLen;
|
|
mfZ /= fLen;
|
|
}
|
|
}
|
|
}
|
|
|
|
return *this;
|
|
}
|
|
|
|
B3DVector B3DVector::getPerpendicular(const B3DVector& rNormalizedVec) const
|
|
{
|
|
B3DVector aNew(*this);
|
|
aNew = cross(aNew, rNormalizedVec);
|
|
aNew.normalize();
|
|
return aNew;
|
|
}
|
|
|
|
B3DVector B3DVector::getProjectionOnPlane(const B3DVector& rNormalizedPlane) const
|
|
{
|
|
B3DVector aNew(*this);
|
|
aNew = cross(aNew, rNormalizedPlane);
|
|
aNew = cross(aNew, rNormalizedPlane);
|
|
|
|
aNew.mfX = mfX - aNew.mfX;
|
|
aNew.mfY = mfY - aNew.mfY;
|
|
aNew.mfZ = mfZ - aNew.mfZ;
|
|
|
|
return aNew;
|
|
}
|
|
|
|
B3DVector& B3DVector::operator*=( const ::basegfx::B3DHomMatrix& rMat )
|
|
{
|
|
const double fTempX( rMat.get(0,0)*mfX + rMat.get(0,1)*mfY + rMat.get(0,2)*mfZ );
|
|
const double fTempY( rMat.get(1,0)*mfX + rMat.get(1,1)*mfY + rMat.get(1,2)*mfZ );
|
|
const double fTempZ( rMat.get(2,0)*mfX + rMat.get(2,1)*mfY + rMat.get(2,2)*mfZ );
|
|
mfX = fTempX;
|
|
mfY = fTempY;
|
|
mfZ = fTempZ;
|
|
|
|
return *this;
|
|
}
|
|
|
|
B3DVector operator*( const ::basegfx::B3DHomMatrix& rMat, const B3DVector& rVec )
|
|
{
|
|
B3DVector aRes( rVec );
|
|
return aRes*=rMat;
|
|
}
|
|
} // end of namespace basegfx
|
|
|
|
// eof
|