b311480e |
1 | // Copyright (c) 1995-1999 Matra Datavision |
973c2be1 |
2 | // Copyright (c) 1999-2014 OPEN CASCADE SAS |
b311480e |
3 | // |
973c2be1 |
4 | // This file is part of Open CASCADE Technology software library. |
b311480e |
5 | // |
973c2be1 |
6 | // This library is free software; you can redistribute it and / or modify it |
7 | // under the terms of the GNU Lesser General Public 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. |
b311480e |
11 | // |
973c2be1 |
12 | // Alternatively, this file may be used under the terms of Open CASCADE |
13 | // commercial license or contractual agreement. |
b311480e |
14 | |
7fd59977 |
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 | } |