0024750: Replace instantiations of TCollection generic classes by NCollection templat...
[occt.git] / src / GProp / GProp_PEquation.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_PEquation.ixx>
16 #include <GProp_PrincipalProps.hxx>
17 #include <GProp_PGProps.hxx>
18
19 GProp_PEquation::GProp_PEquation(const TColgp_Array1OfPnt& Pnts, 
20                                        const Standard_Real Tol) 
21 {
22   GProp_PGProps Pmat(Pnts);
23   g = Pmat.CentreOfMass(); 
24   Standard_Real Xg,Yg,Zg;
25   g.Coord(Xg,Yg,Zg);
26   GProp_PrincipalProps Pp = Pmat.PrincipalProperties();
27   gp_Vec V1 = Pp.FirstAxisOfInertia();
28   Standard_Real Xv1,Yv1,Zv1;
29   V1.Coord(Xv1,Yv1,Zv1); 
30   gp_Vec V2 = Pp.SecondAxisOfInertia(); 
31   Standard_Real Xv2,Yv2,Zv2;
32   V2.Coord(Xv2,Yv2,Zv2);
33   gp_Vec V3 = Pp.ThirdAxisOfInertia(); 
34   Standard_Real Xv3,Yv3,Zv3;
35   V3.Coord(Xv3,Yv3,Zv3);
36   Standard_Real D,X,Y,Z;
37   Standard_Real Dmx1 = RealFirst();
38   Standard_Real Dmn1 = RealLast();
39   Standard_Real Dmx2 = RealFirst();
40   Standard_Real Dmn2 = RealLast();
41   Standard_Real Dmx3 = RealFirst();
42   Standard_Real Dmn3 = RealLast();
43
44   for (Standard_Integer i = Pnts.Lower(); i <= Pnts.Upper();i++){
45     Pnts(i).Coord(X,Y,Z);
46     D = (X-Xg)*Xv1 +(Y-Yg)*Yv1 + (Z-Zg)*Zv1;
47     if (D > Dmx1) Dmx1 = D;
48     if (D < Dmn1) Dmn1 = D;
49     D = (X-Xg)*Xv2 +(Y-Yg)*Yv2 + (Z-Zg)*Zv2;
50     if (D > Dmx2) Dmx2 = D;
51     if (D < Dmn2) Dmn2 = D;
52     D = (X-Xg)*Xv3 +(Y-Yg)*Yv3 + (Z-Zg)*Zv3;
53     if (D > Dmx3) Dmx3 = D;
54     if (D < Dmn3) Dmn3 = D;
55   }
56   Standard_Integer dimension= 3 ;
57   Standard_Integer It = 0;
58   if (Abs(Dmx1-Dmn1) <= Tol)  {
59     dimension =dimension-1;
60     It =1;
61   }
62   if (Abs(Dmx2-Dmn2) <= Tol)  {
63     dimension =dimension-1;
64     It =2*(It+1);
65   }
66   if (Abs(Dmx3-Dmn3) <= Tol)  {
67     dimension =dimension-1;
68     It = 3*(It+1);
69   }
70   switch (dimension)  {
71   case 0:
72     {
73       type = GProp_Point;
74       break;
75     }
76   case 1:
77     {
78       type = GProp_Line;
79       if (It == 4) v1 = V3;
80       else if (It == 6) v1 = V2;
81       else v1 = V1; 
82       break;
83     }
84   case 2:
85     {
86       type = GProp_Plane;
87       if (It == 1) v1 = V1;
88       else if (It == 2) v1 =V2;
89       else v1 = V3;
90       break;
91     }
92   case 3:
93     {
94       type = GProp_Space;
95       g.SetXYZ(g.XYZ() + Dmn1*V1.XYZ() + Dmn2*V2.XYZ() + Dmn3*V3.XYZ());
96       v1 = (Dmx1-Dmn1)*V1;      
97       v2 = (Dmx2-Dmn2)*V2;
98       v3 = (Dmx3-Dmn3)*V3;
99       break;
100     }
101   }
102 }
103 Standard_Boolean  GProp_PEquation::IsPlanar() const {
104
105   if (type == GProp_Plane) return Standard_True;
106   else  return Standard_False;
107 }
108
109 Standard_Boolean  GProp_PEquation::IsLinear() const {
110
111   if (type == GProp_Line) return Standard_True;
112   else  return Standard_False;
113 }
114
115 Standard_Boolean  GProp_PEquation::IsPoint() const {
116
117   if (type == GProp_Point) return Standard_True;
118   else  return Standard_False;
119 }
120
121 Standard_Boolean GProp_PEquation::IsSpace() const {
122   if (type == GProp_Space) return Standard_True;
123   else  return Standard_False;
124 }
125
126 gp_Pln  GProp_PEquation::Plane() const {
127   if (!IsPlanar()) Standard_NoSuchObject::Raise();
128   return gp_Pln(g,v1);
129 }
130 gp_Lin  GProp_PEquation::Line() const {
131   if (!IsLinear()) Standard_NoSuchObject::Raise();
132   return gp_Lin(g,gp_Dir(v1));  
133 }
134
135 gp_Pnt  GProp_PEquation::Point() const {
136   if (!IsPoint()) Standard_NoSuchObject::Raise();
137   return g;
138 }
139
140 void GProp_PEquation::Box(gp_Pnt& P  , gp_Vec& V1,
141                              gp_Vec& V2 , gp_Vec& V3) const {
142   if (!IsSpace()) Standard_NoSuchObject::Raise();
143   P = g;
144   V1 = v1;
145   V2 = v2;
146   V3 = v3;
147 }