src/GProp/GProp.cxx

   1 // Copyright (c) 1995-1999 Matra Datavision
   2 // Copyright (c) 1999-2014 OPEN CASCADE SAS
   3 //
   4 // This file is part of Open CASCADE Technology software library.
   5 //
   6 // This library is free software; you can redistribute it and/or modify it under
   7 // the terms of the GNU Lesser General Public License version 2.1 as published
   8 // by the Free Software Foundation, with special exception defined in the file
   9 // OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
  10 // distribution for complete text of the license and disclaimer of any warranty.
  11 //
  12 // Alternatively, this file may be used under the terms of Open CASCADE
  13 // commercial license or contractual agreement.
  14
  15 #include <GProp.ixx>
  16
  17 #include <Standard_DimensionError.hxx>
  18
  19 #include <gp.hxx>
  20 #include <gp_XYZ.hxx>
  21
  22
  23 void GProp::HOperator (
  24
  25                        const gp_Pnt& G,
  26                        const gp_Pnt& Q,
  27                        const Standard_Real Mass,
  28                        gp_Mat&       Operator
  29
  30 ) {
  31
  32   gp_XYZ QG = G.XYZ() - Q.XYZ();
  33   Standard_Real Ixx = QG.Y() * QG.Y() + QG.Z() * QG.Z();
  34   Standard_Real Iyy = QG.X() * QG.X() + QG.Z() * QG.Z();
  35   Standard_Real Izz = QG.Y() * QG.Y() + QG.X() * QG.X();
  36   Standard_Real Ixy =  - QG.X() * QG.Y();
  37   Standard_Real Iyz =  - QG.Y() * QG.Z();
  38   Standard_Real Ixz =  - QG.X() * QG.Z();
  39   Operator.SetCols (gp_XYZ (Ixx, Ixy, Ixz), gp_XYZ (Ixy, Iyy, Iyz),
  40                     gp_XYZ (Ixz, Iyz, Izz));
  41   Operator.Multiply (Mass);
  42 }