524c40f4eea3ec40a22d648db5ac81bd25069727
[occt.git] / src / Select3D / Select3D_SensitiveFace.cxx
1 // Created on: 1995-03-27
2 // Created by: Robert COUBLANC
3 // Copyright (c) 1995-1999 Matra Datavision
4 // Copyright (c) 1999-2012 OPEN CASCADE SAS
5 //
6 // The content of this file is subject to the Open CASCADE Technology Public
7 // License Version 6.5 (the "License"). You may not use the content of this file
8 // except in compliance with the License. Please obtain a copy of the License
9 // at http://www.opencascade.org and read it completely before using this file.
10 //
11 // The Initial Developer of the Original Code is Open CASCADE S.A.S., having its
12 // main offices at: 1, place des Freres Montgolfier, 78280 Guyancourt, France.
13 //
14 // The Original Code and all software distributed under the License is
15 // distributed on an "AS IS" basis, without warranty of any kind, and the
16 // Initial Developer hereby disclaims all such warranties, including without
17 // limitation, any warranties of merchantability, fitness for a particular
18 // purpose or non-infringement. Please see the License for the specific terms
19 // and conditions governing the rights and limitations under the License.
20
21 //Modif on jun-24-97 : introduction de CSLib_Class2d de LBR
22 //                     pour teste si on est dedans ou dehors...
23 //Modif on jul-21-97 : changement en harray1 pour eventuelles connexions ...
24
25 #include <Select3D_SensitiveFace.ixx>
26 #include <Select3D_Projector.hxx>
27 #include <SelectBasics_BasicTool.hxx>
28 #include <gp_Pnt2d.hxx>
29 #include <gp_Pnt.hxx>
30 #include <Precision.hxx>
31 #include <ElCLib.hxx>
32
33 #include <CSLib_Class2d.hxx>
34
35
36 #define AutoInterMask  0x01
37 #define AutoComputeMask  0x02
38 // Standard_True if the flag is one
39 #define AutoInterFlag(aflag)  ( aflag & AutoInterMask )
40 #define AutoComputeFlag(aflag)  ( aflag & AutoComputeMask )
41 // set the flag to one
42 #define SetAutoInterFlag(aflag)  ( aflag = aflag & AutoInterMask)
43 #define SetAutoComputeFlag(aflag)  ( aflag = aflag & AutoComputeMask)
44 // Initialize flags
45 #define AutoInitFlags(aflag) (aflag = 0)
46
47 //==================================================
48 // Function: Hide this constructor to the next version...
49 // Purpose : simply avoid interfering with the version update
50 //==================================================
51
52 Select3D_SensitiveFace::
53 Select3D_SensitiveFace(const Handle(SelectBasics_EntityOwner)& OwnerId,
54                        const TColgp_Array1OfPnt& ThePoints,
55                        const Select3D_TypeOfSensitivity aType):
56 Select3D_SensitivePoly(OwnerId, ThePoints),
57 mytype (aType)
58 {
59   AutoInitFlags(myautointer);
60 }
61
62 //==================================================
63 // Function: Creation
64 // Purpose :
65 //==================================================
66
67 Select3D_SensitiveFace::
68 Select3D_SensitiveFace(const Handle(SelectBasics_EntityOwner)& OwnerId,
69                        const Handle(TColgp_HArray1OfPnt)& ThePoints,
70                        const Select3D_TypeOfSensitivity aType):
71 Select3D_SensitivePoly(OwnerId, ThePoints),
72 mytype (aType)
73 {
74   AutoInitFlags(myautointer);
75 }
76
77 //==================================================
78 // Function: Matches
79 // Purpose :
80 //==================================================
81
82 Standard_Boolean Select3D_SensitiveFace::
83 Matches(const Standard_Real X,
84         const Standard_Real Y,
85         const Standard_Real aTol,
86         Standard_Real& DMin)
87 {
88   Standard_Real DMin2 = 0.;
89   Standard_Real Xmin = 0.,Ymin = 0.,Xmax = 0.,Ymax = 0.;
90   if(!Bnd_Box2d(mybox2d).IsVoid())
91   {
92     Bnd_Box2d(mybox2d).Get(Xmin,Ymin,Xmax,Ymax);
93     DMin2 = gp_XY(Xmax-Xmin,Ymax-Ymin).SquareModulus();
94   }
95   // calculation of a criterion of minimum distance...
96   // from start Dmin = size of the bounding box 2D,
97   // then min. distance of the polyhedron or cdg...
98
99   Standard_Real aTol2 = aTol*aTol;
100   Standard_Integer aSize = mypolyg.Size(), anIndex;
101   gp_XY CDG;
102   for(anIndex=0;anIndex<aSize;++anIndex)
103   {
104     CDG+=mypolyg.Pnt2d(anIndex);
105   }
106
107   if(aSize>1)
108   {
109     CDG/=(aSize-1);
110   }
111   DMin2=Min(DMin2,gp_XY(CDG.X()-X,CDG.Y()-Y).SquareModulus());
112   DMin = Sqrt(DMin2);
113
114   Standard_Boolean isplane2d(Standard_True);
115
116   for(anIndex=1;anIndex<aSize;++anIndex)
117   {
118     gp_XY V1(mypolyg.Pnt2d(anIndex)),V(X,Y);
119     V1-=mypolyg.Pnt2d(anIndex-1);
120     V-=mypolyg.Pnt2d(anIndex-1);
121     Standard_Real Vector = V1^V;
122     Standard_Real V1V1 = V1.SquareModulus();
123     DMin2 =
124       (V1V1 <=aTol2) ?
125     Min(DMin2,V.SquareModulus()): // if the segment is too small...
126       Min(DMin2,Vector*Vector/V1V1);
127     //cdg ...
128     gp_XY PlaneTest(CDG);
129     PlaneTest-=mypolyg.Pnt2d(anIndex-1);
130     Standard_Real valtst = PlaneTest^V1;
131     if(isplane2d && Abs(valtst)>aTol) isplane2d=Standard_False;
132   }
133   if (isplane2d)
134   {
135     return Select3D_SensitiveEntity::Matches(X,Y,aTol,DMin);
136   }
137
138   //otherwise it is checked if the point is in the face...
139   TColgp_Array1OfPnt2d aArrayOf2dPnt(1, aSize);
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   {
147   case 0:
148     res = Standard_True;
149   case 1:
150     {
151       if(mytype!=Select3D_TOS_BOUNDARY)
152         res = Standard_True;
153     }
154   }
155   if (res)
156   {
157     return Select3D_SensitiveEntity::Matches(X,Y,aTol,DMin);
158   }
159   return Standard_False;
160 }
161
162 //=======================================================================
163 //function : Matches
164 //purpose  :
165 //=======================================================================
166
167 Standard_Boolean Select3D_SensitiveFace::
168 Matches (const Standard_Real XMin,
169          const Standard_Real YMin,
170          const Standard_Real XMax,
171          const Standard_Real YMax,
172          const Standard_Real aTol)
173 {
174   Bnd_Box2d BoundBox;
175   BoundBox.Update(XMin-aTol,YMin-aTol,XMax+aTol,YMax+aTol);
176
177   for(Standard_Integer anIndex=0;anIndex<mypolyg.Size();++anIndex)
178   {
179     if(BoundBox.IsOut(mypolyg.Pnt2d(anIndex)))
180       return Standard_False;
181   }
182   return Standard_True;
183 }
184
185 //=======================================================================
186 //function : Matches
187 //purpose  :
188 //=======================================================================
189
190 Standard_Boolean Select3D_SensitiveFace::
191 Matches (const TColgp_Array1OfPnt2d& aPoly,
192          const Bnd_Box2d& aBox,
193          const Standard_Real aTol)
194 {
195   Standard_Real Umin,Vmin,Umax,Vmax;
196   aBox.Get(Umin,Vmin,Umax,Vmax);
197   CSLib_Class2d aClassifier2d(aPoly,aTol,aTol,Umin,Vmin,Umax,Vmax);
198
199   gp_Pnt2d aPnt2d;
200   for(Standard_Integer anIndex=0;anIndex<mypolyg.Size();++anIndex)
201   {
202     Standard_Integer RES = aClassifier2d.SiDans(mypolyg.Pnt2d(anIndex));
203     if(RES!=1)
204       return Standard_False;
205   }
206   return Standard_True;
207 }
208
209 //=======================================================================
210 //function : Dump
211 //purpose  :
212 //=======================================================================
213
214 void Select3D_SensitiveFace::Dump(Standard_OStream& S,const Standard_Boolean FullDump) const
215 {
216   S<<"\tSensitiveFace 3D :"<<endl;;
217   if(HasLocation())
218     S<<"\t\tExisting Location"<<endl;
219
220   if(mytype==Select3D_TOS_BOUNDARY)
221     S<<"\t\tSelection Of Bounding Polyline Only"<<endl;
222
223   if(FullDump)
224   {
225     S<<"\t\tNumber Of Points :"<<mypolyg.Size()<<endl;
226     Select3D_SensitiveEntity::DumpBox(S,mybox2d);
227   }
228 }
229
230 //=======================================================================
231 //function : ComputeDepth
232 //purpose  :
233 //=======================================================================
234
235 Standard_Real Select3D_SensitiveFace::ComputeDepth(const gp_Lin& EyeLine) const
236 {
237   Standard_Real aDepth = Precision::Infinite();
238
239   Standard_Real aDepthMin = !mylastprj.IsNull() ? mylastprj->DepthMin() : -Precision::Infinite();
240   Standard_Real aDepthMax = !mylastprj.IsNull() ? mylastprj->DepthMax() :  Precision::Infinite();
241   Standard_Real aDepthTest;
242
243   for (Standard_Integer anIndex = 0; anIndex < mypolyg.Size()-1; ++anIndex)
244   {
245     aDepthTest = ElCLib::Parameter (EyeLine, mypolyg.Pnt(anIndex));
246     if (aDepthTest < aDepth && (aDepthTest > aDepthMin) && (aDepthTest < aDepthMax))
247     {
248       aDepth = aDepthTest;
249     }
250   }
251   return aDepth;
252 }
253
254 //=======================================================================
255 //function : GetConnected
256 //purpose  :
257 //=======================================================================
258
259 Handle(Select3D_SensitiveEntity) Select3D_SensitiveFace::GetConnected(const TopLoc_Location &theLocation)
260 {
261   // Create a copy of this
262   Standard_Integer aSize = mypolyg.Size();
263   TColgp_Array1OfPnt aPoints(1, aSize);
264   for (Standard_Integer anIndex = 1; anIndex <= aSize; ++anIndex)
265   {
266     aPoints.SetValue(anIndex, mypolyg.Pnt(anIndex-1));
267   }
268
269   Handle(Select3D_SensitiveEntity) aNewEntity =
270     new Select3D_SensitiveFace(myOwnerId, aPoints, mytype);
271
272   if (HasLocation())
273     aNewEntity->SetLocation(Location());
274
275   aNewEntity->UpdateLocation(theLocation);
276
277   return aNewEntity;
278 }