basegfx/source/vector/b3dvector.cxx

   1 /* -*- Mode: C++; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */
   2 /*
   3  * This file is part of the LibreOffice project.
   4  *
   5  * This Source Code Form is subject to the terms of the Mozilla Public
   6  * License, v. 2.0. If a copy of the MPL was not distributed with this
   7  * file, You can obtain one at http://mozilla.org/MPL/2.0/.
   8  *
   9  * This file incorporates work covered by the following license notice:
  10  *
  11  *   Licensed to the Apache Software Foundation (ASF) under one or more
  12  *   contributor license agreements. See the NOTICE file distributed
  13  *   with this work for additional information regarding copyright
  14  *   ownership. The ASF licenses this file to you under the Apache
  15  *   License, Version 2.0 (the "License"); you may not use this file
  16  *   except in compliance with the License. You may obtain a copy of
  17  *   the License at http://www.apache.org/licenses/LICENSE-2.0 .
  18  */
  19
  20 #include <basegfx/vector/b3dvector.hxx>
  21 #include <basegfx/matrix/b3dhommatrix.hxx>
  22
  23 namespace basegfx
  24 {
  25     B3DVector& B3DVector::normalize()
  26     {
  27         double fLen(scalar(*this));
  28
  29         if(!::basegfx::fTools::equalZero(fLen))
  30         {
  31             const double fOne(1.0);
  32
  33             if(!::basegfx::fTools::equal(fOne, fLen))
  34             {
  35                 fLen = sqrt(fLen);
  36
  37                 mfX /= fLen;
  38                 mfY /= fLen;
  39                 mfZ /= fLen;
  40             }
  41         }
  42
  43         return *this;
  44     }
  45
  46     B3DVector B3DVector::getPerpendicular(const B3DVector& rNormalizedVec) const
  47     {
  48         B3DVector aNew = cross(*this, rNormalizedVec);
  49         aNew.normalize();
  50         return aNew;
  51     }
  52
  53     B3DVector& B3DVector::operator*=( const ::basegfx::B3DHomMatrix& rMat )
  54     {
  55         const double fTempX( rMat.get(0,0)*mfX + rMat.get(0,1)*mfY + rMat.get(0,2)*mfZ );
  56         const double fTempY( rMat.get(1,0)*mfX + rMat.get(1,1)*mfY + rMat.get(1,2)*mfZ );
  57         const double fTempZ( rMat.get(2,0)*mfX + rMat.get(2,1)*mfY + rMat.get(2,2)*mfZ );
  58         mfX = fTempX;
  59         mfY = fTempY;
  60         mfZ = fTempZ;
  61
  62         return *this;
  63     }
  64
  65     B3DVector operator*( const ::basegfx::B3DHomMatrix& rMat, const B3DVector& rVec )
  66     {
  67         B3DVector aRes( rVec );
  68         aRes *= rMat;
  69         return aRes;
  70     }
  71
  72     bool areParallel( const B3DVector& rVecA, const B3DVector& rVecB )
  73     {
  74         // i think fastest is to compare relations, need no square or division
  75         if(!fTools::equal(rVecA.getX() * rVecB.getY(), rVecA.getY() * rVecB.getX()))
  76             return false;
  77
  78         if(!fTools::equal(rVecA.getX() * rVecB.getZ(), rVecA.getZ() * rVecB.getX()))
  79             return false;
  80
  81         return fTools::equal(rVecA.getY() * rVecB.getZ(), rVecA.getZ() * rVecB.getY());
  82     }
  83
  84 } // end of namespace basegfx
  85
  86 /* vim:set shiftwidth=4 softtabstop=4 expandtab: */