basegfx/source/point/b3ipoint.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/point/b3ipoint.hxx>
  21 #include <basegfx/matrix/b3dhommatrix.hxx>
  22 #include <basegfx/numeric/ftools.hxx>
  23
  24 namespace basegfx
  25 {
  26     B3IPoint& B3IPoint::operator*=( const ::basegfx::B3DHomMatrix& rMat )
  27     {
  28         double fTempX(
  29             rMat.get(0, 0) * mnX +
  30             rMat.get(0, 1) * mnY +
  31             rMat.get(0, 2) * mnZ +
  32             rMat.get(0, 3));
  33         double fTempY(
  34             rMat.get(1, 0) * mnX +
  35             rMat.get(1, 1) * mnY +
  36             rMat.get(1, 2) * mnZ +
  37             rMat.get(1, 3));
  38         double fTempZ(
  39             rMat.get(2, 0) * mnX +
  40             rMat.get(2, 1) * mnY +
  41             rMat.get(2, 2) * mnZ +
  42             rMat.get(2, 3));
  43
  44         if(!rMat.isLastLineDefault())
  45         {
  46             const double fOne(1.0);
  47             const double fTempM(
  48                 rMat.get(3, 0) * mnX +
  49                 rMat.get(3, 1) * mnY +
  50                 rMat.get(3, 2) * mnZ +
  51                 rMat.get(3, 3));
  52
  53             if(!fTools::equalZero(fTempM) && !fTools::equal(fOne, fTempM))
  54             {
  55                 fTempX /= fTempM;
  56                 fTempY /= fTempM;
  57                 fTempZ /= fTempM;
  58             }
  59         }
  60
  61         mnX = fround(fTempX);
  62         mnY = fround(fTempY);
  63         mnZ = fround(fTempZ);
  64
  65         return *this;
  66     }
  67 } // end of namespace basegfx
  68
  69 /* vim:set shiftwidth=4 softtabstop=4 expandtab: */