| /************************************************************** | |
| * | |
| * Licensed to the Apache Software Foundation (ASF) under one | |
| * or more contributor license agreements. See the NOTICE file | |
| * distributed with this work for additional information | |
| * regarding copyright ownership. The ASF licenses this file | |
| * to you under the Apache License, Version 2.0 (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.apache.org/licenses/LICENSE-2.0 | |
| * | |
| * Unless required by applicable law or agreed to in writing, | |
| * software distributed under the License is distributed on an | |
| * "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY | |
| * KIND, either express or implied. See the License for the | |
| * specific language governing permissions and limitations | |
| * under the License. | |
| * | |
| *************************************************************/ | |
| // MARKER(update_precomp.py): autogen include statement, do not remove | |
| #include "precompiled_basegfx.hxx" | |
| #include <basegfx/vector/b3dvector.hxx> | |
| #include <basegfx/matrix/b3dhommatrix.hxx> | |
| 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; | |
| } | |
| bool areParallel( const B3DVector& rVecA, const B3DVector& rVecB ) | |
| { | |
| // I think fastest is to compare relations, need no square or division | |
| if(!fTools::equal(rVecA.getX() * rVecB.getY(), rVecA.getY() * rVecB.getX())) | |
| return false; | |
| if(!fTools::equal(rVecA.getX() * rVecB.getZ(), rVecA.getZ() * rVecB.getX())) | |
| return false; | |
| return (fTools::equal(rVecA.getY() * rVecB.getZ(), rVecA.getZ() * rVecB.getY())); | |
| } | |
| } // end of namespace basegfx | |
| /* vim: set noet sw=4 ts=4: */ |