9090795a260fccf0ee6c35d5701c5f9f8e9fb339
[occt.git] / src / Select3D / Select3D_SensitiveFace.cxx
1 // Copyright:   Matra-Datavision 1995
2 // File:    Select3D_SensitiveFace.cxx
3 // Created: Mon Mar 27 10:15:15 1995
4 // Author:  Robert COUBLANC
5 //      <rob>
6 //Modif on jun-24-97 : introduction de CSLib_Class2d de LBR
7 //                     pour teste si on est dedans ou dehors...
8 //Modif on jul-21-97 : changement en harray1 pour eventuelles connexions ...
9
10 #include <Select3D_SensitiveFace.ixx>
11 #include <SelectBasics_BasicTool.hxx>
12 #include <gp_Pnt2d.hxx>
13 #include <gp_Pnt.hxx>
14 #include <Precision.hxx>
15 #include <ElCLib.hxx>
16
17 #include <CSLib_Class2d.hxx>
18
19
20 #define AutoInterMask  0x01
21 #define AutoComputeMask  0x02
22 // Standard_True if the flag is one
23 #define AutoInterFlag(aflag)  ( aflag & AutoInterMask )
24 #define AutoComputeFlag(aflag)  ( aflag & AutoComputeMask )
25 // set the flag to one
26 #define SetAutoInterFlag(aflag)  ( aflag = aflag & AutoInterMask)
27 #define SetAutoComputeFlag(aflag)  ( aflag = aflag & AutoComputeMask)
28 // Initialize flags
29 #define AutoInitFlags(aflag) (aflag = 0)
30
31 //==================================================
32 // Function: Hide this constructor to the next version...
33 // Purpose : simply avoid interfering with the version update
34 //==================================================
35
36 Select3D_SensitiveFace::
37 Select3D_SensitiveFace(const Handle(SelectBasics_EntityOwner)& OwnerId,
38                const TColgp_Array1OfPnt& ThePoints,
39                const Select3D_TypeOfSensitivity aType):
40 Select3D_SensitivePoly(OwnerId, ThePoints),
41 mytype (aType),
42 myDetectedIndex(-1)
43 {
44   AutoInitFlags(myautointer);
45 }
46
47 //==================================================
48 // Function: 
49 // Purpose :
50 //==================================================
51
52 Select3D_SensitiveFace::
53 Select3D_SensitiveFace(const Handle(SelectBasics_EntityOwner)& OwnerId,
54                const Handle(TColgp_HArray1OfPnt)& ThePoints,
55                const Select3D_TypeOfSensitivity aType):
56 Select3D_SensitivePoly(OwnerId, ThePoints),
57 mytype (aType),
58 myDetectedIndex(-1)
59 {
60   AutoInitFlags(myautointer);
61 }
62
63 //==================================================
64 // Function: 
65 // Purpose :
66 //==================================================
67
68 Standard_Boolean Select3D_SensitiveFace::
69 Matches(const Standard_Real X,
70     const Standard_Real Y,
71     const Standard_Real aTol,
72     Standard_Real& DMin)
73 {
74 #ifndef DEB
75   Standard_Real DMin2 = 0.;
76 #else
77   Standard_Real DMin2;
78 #endif
79   Standard_Real Xmin,Ymin,Xmax,Ymax;
80   if(!Bnd_Box2d(mybox2d).IsVoid()){
81     Bnd_Box2d(mybox2d).Get(Xmin,Ymin,Xmax,Ymax);
82     DMin2 = gp_XY(Xmax-Xmin,Ymax-Ymin).SquareModulus();
83   }
84   // calculation of a criterion of minimum distance...
85   // from start Dmin = size of the bounding box 2D,
86   // then min. distance of the polyhedron or cdg...
87
88   Standard_Real aTol2 = aTol*aTol;
89   gp_XY CDG(0.,0.);
90 //  for(Standard_Integer I=1;I<=Nbp-1;I++){
91   Standard_Integer I;
92   for(I=1;I<mynbpoints-1;I++){
93     CDG+=((Select3D_Pnt2d*)mypolyg2d)[I-1];
94   }
95   
96   if(mynbpoints>1){
97     CDG/= (mynbpoints-1);
98   }
99   DMin2=Min(DMin2,gp_XY(CDG.X()-X,CDG.Y()-Y).SquareModulus());
100   DMin = Sqrt(DMin2);
101   
102   
103   Standard_Boolean isplane2d(Standard_True);
104   
105   for( I=1;I<mynbpoints-1;I++){
106     gp_XY V1(((Select3D_Pnt2d*)mypolyg2d)[I]),V(X,Y);
107     V1-=((Select3D_Pnt2d*)mypolyg2d)[I-1];
108     V-=((Select3D_Pnt2d*)mypolyg2d)[I-1];
109     Standard_Real Vector = V1^V;
110     Standard_Real V1V1 = V1.SquareModulus();
111     DMin2 = 
112       (V1V1 <=aTol2) ? 
113     Min(DMin2,V.SquareModulus()): // if the segment is too small...
114       Min(DMin2,Vector*Vector/V1V1);
115     //cdg ...
116     gp_XY PlaneTest(CDG);PlaneTest-=((Select3D_Pnt2d*)mypolyg2d)[I-1];
117     Standard_Real valtst = PlaneTest^V1;
118     if(isplane2d && Abs(valtst)>aTol) isplane2d=Standard_False;
119   }
120
121   if(isplane2d) {
122     Select3D_SensitiveEntity::Matches(X,Y,aTol,DMin);
123     
124     return Standard_True;
125   }
126   //detection d'une auto - intersection dans le polygon 2D; si oui on sort
127 //    if (!AutoComputeFlag(myautointer)) {
128 //      if(mypolyg2d.Length()>4) {
129 //        if (SelectBasics_BasicTool::AutoInter(mypolyg2d)) {
130 //      SetAutoInterFlag(myautointer);
131 //        }
132 //      }
133 //      SetAutoComputeFlag(myautointer);
134 //    }
135 //   if (AutoInterFlag(myautointer)) return Standard_True;
136 // //  
137
138   //otherwise it is checked if the point is in the face...
139   TColgp_Array1OfPnt2d aArrayOf2dPnt(1, mynbpoints);
140   Points2D(aArrayOf2dPnt);
141   CSLib_Class2d TheInOutTool(aArrayOf2dPnt,aTol,aTol,Xmin,Ymin,Xmax,Ymax);
142   Standard_Integer TheStat = TheInOutTool.SiDans(gp_Pnt2d(X,Y));
143   
144   Standard_Boolean res(Standard_False);
145   switch(TheStat){
146   case 0:
147     res = Standard_True;
148   case 1:
149     {
150       if(mytype!=Select3D_TOS_BOUNDARY)
151         res = Standard_True;
152     }
153   }
154   if(res)
155     Select3D_SensitiveEntity::Matches(X,Y,aTol,DMin);
156     
157   return res;
158 }
159
160 //=======================================================================
161 //function : Matches
162 //purpose  : 
163 //=======================================================================
164
165 Standard_Boolean Select3D_SensitiveFace::
166 Matches (const Standard_Real XMin,
167      const Standard_Real YMin,
168      const Standard_Real XMax,
169      const Standard_Real YMax,
170      const Standard_Real aTol)
171
172   Bnd_Box2d BoundBox;
173   BoundBox.Update(XMin-aTol,YMin-aTol,XMax+aTol,YMax+aTol);
174   
175   for(Standard_Integer j=1;j<=mynbpoints-1;j++){
176     if(BoundBox.IsOut(((Select3D_Pnt2d*)mypolyg2d)[j-1])) return Standard_False;
177   }
178   return Standard_True;
179 }
180
181 //=======================================================================
182 //function : Matches
183 //purpose  : 
184 //=======================================================================
185
186 Standard_Boolean Select3D_SensitiveFace::
187 Matches (const TColgp_Array1OfPnt2d& aPoly,
188      const Bnd_Box2d& aBox,
189      const Standard_Real aTol)
190
191   Standard_Real Umin,Vmin,Umax,Vmax;
192   aBox.Get(Umin,Vmin,Umax,Vmax);
193   Standard_Real Tolu,Tolv;
194   Tolu = 1e-7;
195   Tolv = 1e-7;
196   CSLib_Class2d aClassifier2d(aPoly,aTol,aTol,Umin,Vmin,Umax,Vmax);
197
198   for(Standard_Integer j=1;j<=mynbpoints;j++){
199     Standard_Integer RES = aClassifier2d.SiDans(((Select3D_Pnt2d*)mypolyg2d)[j-1]);
200     if(RES!=1) return Standard_False;
201   }
202   return Standard_True;
203 }
204
205
206 //=======================================================================
207 //function : Dump
208 //purpose  : 
209 //=======================================================================
210 void Select3D_SensitiveFace::Dump(Standard_OStream& S,const Standard_Boolean FullDump) const
211 {
212   S<<"\tSensitiveFace 3D :"<<endl;;
213   if(HasLocation())
214     S<<"\t\tExisting Location"<<endl;
215   
216   if(mytype==Select3D_TOS_BOUNDARY) 
217     S<<"\t\tSelection Of Bounding Polyline Only"<<endl;
218   
219   if(FullDump){
220     S<<"\t\tNumber Of Points :"<<mynbpoints<<endl;
221     
222 //    S<<"\t\t\tOwner:"<<myOwnerId<<endl;
223     Select3D_SensitiveEntity::DumpBox(S,mybox2d);
224   }
225 }
226
227 //=======================================================================
228 //function : ComputeDepth
229 //purpose  : 
230 //=======================================================================
231 Standard_Real Select3D_SensitiveFace::ComputeDepth(const gp_Lin& EyeLine) const
232 {
233   Standard_Real val(Precision::Infinite());
234   for(Standard_Integer i=0;i<mynbpoints-1;i++)
235     val = Min(val,ElCLib::Parameter(EyeLine,((Select3D_Pnt*)mypolyg3d)[i]));
236   return val;
237 }