0024750: Replace instantiations of TCollection generic classes by NCollection templat...
[occt.git] / 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 }