basegfx/source/vector/b3dvector.cxx

   1 /*************************************************************************
   2  *
   3  * DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
   4  *
   5  * Copyright 2008 by Sun Microsystems, Inc.
   6  *
   7  * OpenOffice.org - a multi-platform office productivity suite
   8  *
   9  * $RCSfile: b3dvector.cxx,v $
  10  * $Revision: 1.9.4.1 $
  11  *
  12  * This file is part of OpenOffice.org.
  13  *
  14  * OpenOffice.org is free software: you can redistribute it and/or modify
  15  * it under the terms of the GNU Lesser General Public License version 3
  16  * only, as published by the Free Software Foundation.
  17  *
  18  * OpenOffice.org is distributed in the hope that it will be useful,
  19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  21  * GNU Lesser General Public License version 3 for more details
  22  * (a copy is included in the LICENSE file that accompanied this code).
  23  *
  24  * You should have received a copy of the GNU Lesser General Public License
  25  * version 3 along with OpenOffice.org.  If not, see
  26  * <http://www.openoffice.org/license.html>
  27  * for a copy of the LGPLv3 License.
  28  *
  29  ************************************************************************/
  30
  31 // MARKER(update_precomp.py): autogen include statement, do not remove
  32 #include "precompiled_basegfx.hxx"
  33 #include <basegfx/vector/b3dvector.hxx>
  34 #include <basegfx/matrix/b3dhommatrix.hxx>
  35
  36 //////////////////////////////////////////////////////////////////////////////
  37
  38 namespace basegfx
  39 {
  40     B3DVector& B3DVector::normalize()
  41     {
  42         double fLen(scalar(*this));
  43
  44         if(!::basegfx::fTools::equalZero(fLen))
  45         {
  46             const double fOne(1.0);
  47
  48             if(!::basegfx::fTools::equal(fOne, fLen))
  49             {
  50                 fLen = sqrt(fLen);
  51
  52                 if(!::basegfx::fTools::equalZero(fLen))
  53                 {
  54                     mfX /= fLen;
  55                     mfY /= fLen;
  56                     mfZ /= fLen;
  57                 }
  58             }
  59         }
  60
  61         return *this;
  62     }
  63
  64     B3DVector B3DVector::getPerpendicular(const B3DVector& rNormalizedVec) const
  65     {
  66         B3DVector aNew(*this);
  67         aNew = cross(aNew, rNormalizedVec);
  68         aNew.normalize();
  69         return aNew;
  70     }
  71
  72     B3DVector B3DVector::getProjectionOnPlane(const B3DVector& rNormalizedPlane) const
  73     {
  74         B3DVector aNew(*this);
  75         aNew = cross(aNew, rNormalizedPlane);
  76         aNew = cross(aNew, rNormalizedPlane);
  77
  78         aNew.mfX = mfX - aNew.mfX;
  79         aNew.mfY = mfY - aNew.mfY;
  80         aNew.mfZ = mfZ - aNew.mfZ;
  81
  82         return aNew;
  83     }
  84
  85     B3DVector& B3DVector::operator*=( const ::basegfx::B3DHomMatrix& rMat )
  86     {
  87         const double fTempX( rMat.get(0,0)*mfX + rMat.get(0,1)*mfY + rMat.get(0,2)*mfZ );
  88         const double fTempY( rMat.get(1,0)*mfX + rMat.get(1,1)*mfY + rMat.get(1,2)*mfZ );
  89         const double fTempZ( rMat.get(2,0)*mfX + rMat.get(2,1)*mfY + rMat.get(2,2)*mfZ );
  90         mfX = fTempX;
  91         mfY = fTempY;
  92         mfZ = fTempZ;
  93
  94         return *this;
  95     }
  96
  97     B3DVector operator*( const ::basegfx::B3DHomMatrix& rMat, const B3DVector& rVec )
  98     {
  99         B3DVector aRes( rVec );
 100         return aRes*=rMat;
 101     }
 102
 103     bool areParallel( const B3DVector& rVecA, const B3DVector& rVecB )
 104     {
 105         // i think fastest is to compare relations, need no square or division
 106         if(!fTools::equal(rVecA.getX() * rVecB.getY(), rVecA.getY() * rVecB.getX()))
 107             return false;
 108
 109         if(!fTools::equal(rVecA.getX() * rVecB.getZ(), rVecA.getZ() * rVecB.getX()))
 110             return false;
 111
 112         return (fTools::equal(rVecA.getY() * rVecB.getZ(), rVecA.getZ() * rVecB.getY()));
 113     }
 114
 115 } // end of namespace basegfx
 116
 117 //////////////////////////////////////////////////////////////////////////////
 118 // eof