0023024: Update headers of OCCT files
[occt.git] / src / ShapeAnalysis / ShapeAnalysis_Geom.cxx
1 // Copyright (c) 1999-2012 OPEN CASCADE SAS
2 //
3 // The content of this file is subject to the Open CASCADE Technology Public
4 // License Version 6.5 (the "License"). You may not use the content of this file
5 // except in compliance with the License. Please obtain a copy of the License
6 // at http://www.opencascade.org and read it completely before using this file.
7 //
8 // The Initial Developer of the Original Code is Open CASCADE S.A.S., having its
9 // main offices at: 1, place des Freres Montgolfier, 78280 Guyancourt, France.
10 //
11 // The Original Code and all software distributed under the License is
12 // distributed on an "AS IS" basis, without warranty of any kind, and the
13 // Initial Developer hereby disclaims all such warranties, including without
14 // limitation, any warranties of merchantability, fitness for a particular
15 // purpose or non-infringement. Please see the License for the specific terms
16 // and conditions governing the rights and limitations under the License.
17
18 //szv#4 S4163
19 #include <ShapeAnalysis_Geom.ixx>
20
21 #include <GProp_PGProps.hxx>
22 #include <GProp_PrincipalProps.hxx>
23
24 #include <gp_Dir.hxx>
25 #include <gp_GTrsf.hxx>
26 #include <gp_Pln.hxx>
27 #include <gp_Pnt.hxx>
28 #include <gp_Trsf.hxx>
29 #include <gp_Vec.hxx>
30 #include <gp_XYZ.hxx>
31
32 #include <Standard_ErrorHandler.hxx>
33 #include <Standard_Failure.hxx>
34
35 //=======================================================================
36 //function : NearestPlane
37 //purpose  : 
38 //=======================================================================
39
40 Standard_Boolean ShapeAnalysis_Geom::NearestPlane(const TColgp_Array1OfPnt& Pnts,
41                                                    gp_Pln& aPln, Standard_Real& Dmax)
42 {
43   //szv#4:S4163:12Mar99 warning
44   GProp_PGProps Pmat(Pnts);
45   gp_Pnt g = Pmat.CentreOfMass();
46   Standard_Real Xg,Yg,Zg;
47   g.Coord(Xg,Yg,Zg);
48
49   GProp_PrincipalProps Pp = Pmat.PrincipalProperties();
50   gp_Vec V1 = Pp.FirstAxisOfInertia();
51   Standard_Real Xv1,Yv1,Zv1;
52   V1.Coord(Xv1,Yv1,Zv1); 
53   gp_Vec V2 = Pp.SecondAxisOfInertia(); 
54   Standard_Real Xv2,Yv2,Zv2;
55   V2.Coord(Xv2,Yv2,Zv2);
56   gp_Vec V3 = Pp.ThirdAxisOfInertia(); 
57   Standard_Real Xv3,Yv3,Zv3;
58   V3.Coord(Xv3,Yv3,Zv3);
59
60   Standard_Real D,X,Y,Z;
61   Standard_Real Dmx1 = RealFirst();
62   Standard_Real Dmn1 = RealLast();
63   Standard_Real Dmx2 = RealFirst();
64   Standard_Real Dmn2 = RealLast();
65   Standard_Real Dmx3 = RealFirst();
66   Standard_Real Dmn3 = RealLast();
67
68   Standard_Integer ilow = Pnts.Lower(), iup = Pnts.Upper();
69   Standard_Integer i; // svv Jan11 2000 : porting on DEC
70   for (i = ilow; i <= iup; i ++) {
71     Pnts(i).Coord(X,Y,Z);
72     D = (X-Xg)*Xv1 +(Y-Yg)*Yv1 + (Z-Zg)*Zv1;
73     if (D > Dmx1) Dmx1 = D;
74     if (D < Dmn1) Dmn1 = D;
75     D = (X-Xg)*Xv2 +(Y-Yg)*Yv2 + (Z-Zg)*Zv2;
76     if (D > Dmx2) Dmx2 = D;
77     if (D < Dmn2) Dmn2 = D;
78     D = (X-Xg)*Xv3 +(Y-Yg)*Yv3 + (Z-Zg)*Zv3;
79     if (D > Dmx3) Dmx3 = D;
80     if (D < Dmn3) Dmn3 = D;
81   }
82
83   //szv#4:S4163:12Mar99 optimized
84   Standard_Real Dev1 = Dmx1-Dmn1, Dev2 = Dmx2-Dmn2, Dev3 = Dmx3-Dmn3;
85   Standard_Integer It = (Dev1 < Dev2)? ((Dev1 < Dev3)? 1 : 3) : ((Dev2 < Dev3)? 2 : 3);
86
87   switch (It) {
88   case 1:
89     {
90     //szv#4:S4163:12Mar99 optimized
91     if ((2.*Dev1 > Dev2) || (2.*Dev1 > Dev3)) It = 0;
92     else aPln = gp_Pln(g,V1);
93     break;
94     }
95   case 2:
96     {
97     //szv#4:S4163:12Mar99 optimized
98     if ((2.*Dev2 > Dev1) || (2.*Dev2 > Dev3)) It = 0;
99     else aPln = gp_Pln(g,V2);
100     break;
101     }
102   case 3:
103     {
104     //szv#4:S4163:12Mar99 optimized
105     if ((2.*Dev3 > Dev2) || (2.*Dev3 > Dev1)) It = 0;
106     else aPln = gp_Pln(g,V3);
107     break;
108     }
109   }
110
111   Dmax = RealFirst();
112   if ( It != 0 ) //szv#4:S4163:12Mar99 anti-exception
113     for (i = ilow; i <= iup; i ++) {
114       D = aPln.Distance (Pnts(i));
115       if (Dmax < D) Dmax = D;
116     }
117
118   return (It != 0);
119 }
120
121 //=======================================================================
122 //function : PositionTrsf
123 //purpose  : 
124 //=======================================================================
125
126  Standard_Boolean ShapeAnalysis_Geom::PositionTrsf(const Handle(TColStd_HArray2OfReal)& coefs,gp_Trsf& trsf,
127                                                    const Standard_Real unit,const Standard_Real prec)
128 {
129   Standard_Boolean result = Standard_True;
130
131   trsf = gp_Trsf(); //szv#4:S4163:12Mar99 moved
132
133   if (coefs.IsNull()) return Standard_True; //szv#4:S4163:12Mar99 moved
134
135   gp_GTrsf gtrsf;
136   for (Standard_Integer i = 1; i <= 3; i ++)
137     for (Standard_Integer j = 1; j <= 4; j ++)
138       gtrsf.SetValue (i,j, coefs->Value(i,j));
139
140   //try { //szv#4:S4163:12Mar99 waste try
141     ////    trsf = gtrsf.Trsf();
142     // ---  Prec et Unit ont ete lues suite aux StepFile_Read
143     //      Valables pour tous les composants d un assemblage transmis
144     //trsf = gp_Trsf();  // Identite forcee au depart //szv#4:S4163:12Mar99 not needed
145     //  On prend le contenu de <gtrsf>. Attention a l adressage
146     gp_XYZ v1 ( gtrsf.Value(1,1), gtrsf.Value(2,1), gtrsf.Value(3,1) );
147     gp_XYZ v2 ( gtrsf.Value(1,2), gtrsf.Value(2,2), gtrsf.Value(3,2) );
148     gp_XYZ v3 ( gtrsf.Value(1,3), gtrsf.Value(2,3), gtrsf.Value(3,3) );
149     //  A-t-on affaire a une similitude ?
150     Standard_Real m1 = v1.Modulus();
151     Standard_Real m2 = v2.Modulus();
152     Standard_Real m3 = v3.Modulus();
153
154     //    D abord est-elle singuliere cette matrice ?
155     if (m1 < prec || m2 < prec || m3 < prec) return Standard_False;
156     Standard_Real mm = (m1+m2+m3)/3.;  // voici la Norme moyenne, cf Scale
157     //szv#4:S4163:12Mar99 optimized
158     Standard_Real pmm = prec*mm;
159     if ( Abs(m1 - mm) > pmm || Abs(m2 - mm) > pmm || Abs(m3 - mm) > pmm )
160       return Standard_False;
161     //szv#4:S4163:12Mar99 warning
162     v1.Divide(m1);
163     v2.Divide(m2);
164     v3.Divide(m3);
165     //szv#4:S4163:12Mar99 optimized
166     if ( Abs(v1.Dot(v2)) > prec || Abs(v2.Dot(v3)) > prec || Abs(v3.Dot(v1)) > prec )
167       return Standard_False;
168
169     //  Ici, Orthogonale et memes normes. En plus on l a Normee
170     //  On isole le cas de l Identite (tellement facile et avantageux)
171     if (v1.X() != 1 || v1.Y() != 0 || v1.Z() != 0 ||
172         v2.X() != 0 || v2.Y() != 1 || v2.Z() != 0 ||
173         v3.X() != 0 || v3.Y() != 0 || v3.Z() != 1 ) {
174       //  Pas Identite : vraie construction depuis un Ax3
175       gp_Dir d1(v1);
176       gp_Dir d2(v2);
177       gp_Dir d3(v3);
178       gp_Ax3 axes (gp_Pnt(0,0,0),d3,d1);
179       d3.Cross(d1);
180       if (d3.Dot(d2) < 0) axes.YReverse();
181       trsf.SetTransformation(axes);
182     }
183
184     //  Restent les autres caracteristiques :
185     if ( Abs(mm - 1.) > prec ) trsf.SetScale(gp_Pnt(0,0,0), mm); //szv#4:S4163:12Mar99 optimized
186     gp_Vec tp (gtrsf.TranslationPart());
187     if (unit != 1.) tp.Multiply(unit);
188     if (tp.X() != 0 || tp.Y() != 0 || tp.Z() != 0) trsf.SetTranslationPart(tp);
189   /* }
190   catch(Standard_Failure) {
191     trsf = gp_Trsf();
192     result = Standard_False;
193   } */
194
195   return result;
196 }