0029938: Visualization - SelectMgr_ViewerSelector::PickedPoint() should return point...
[occt.git] / src / SelectMgr / SelectMgr_TriangularFrustumSet.cxx
1 // Created on: 2014-11-21
2 // Created by: Varvara POSKONINA
3 // Copyright (c) 2005-2014 OPEN CASCADE SAS
4 //
5 // This file is part of Open CASCADE Technology software library.
6 //
7 // This library is free software; you can redistribute it and/or modify it under
8 // the terms of the GNU Lesser General Public License version 2.1 as published
9 // by the Free Software Foundation, with special exception defined in the file
10 // OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
11 // distribution for complete text of the license and disclaimer of any warranty.
12 //
13 // Alternatively, this file may be used under the terms of Open CASCADE
14 // commercial license or contractual agreement.
15
16 #include <BRepMesh_DataStructureOfDelaun.hxx>
17 #include <BRepMesh_Delaun.hxx>
18 #include <NCollection_IncAllocator.hxx>
19
20 #include <SelectMgr_TriangularFrustumSet.hxx>
21 #include <SelectMgr_TriangularFrustum.hxx>
22
23 #define MEMORY_BLOCK_SIZE 512 * 7
24
25 // =======================================================================
26 // function : BuildSelectingVolume
27 // purpose  : Meshes polygon bounded by polyline. Than organizes a set of
28 //            triangular frustums, where each triangle's projection onto
29 //            near and far view frustum planes is considered as a frustum
30 //            base
31 // =======================================================================
32 void SelectMgr_TriangularFrustumSet::Build (const TColgp_Array1OfPnt2d& thePoints)
33 {
34   myFrustums.Clear();
35
36   Handle(NCollection_IncAllocator) anAllocator = new NCollection_IncAllocator (MEMORY_BLOCK_SIZE);
37   Handle(BRepMesh_DataStructureOfDelaun) aMeshStructure = new BRepMesh_DataStructureOfDelaun(anAllocator);
38   Standard_Integer aPtsLower = thePoints.Lower();
39   Standard_Integer aPtsUpper = thePoints.Upper();
40   BRepMesh::Array1OfInteger anIndexes (0, thePoints.Length() - 1);
41   for (Standard_Integer aPtIdx = aPtsLower; aPtIdx <= aPtsUpper; ++aPtIdx)
42   {
43     BRepMesh_Vertex aVertex (thePoints.Value (aPtIdx).XY(), aPtIdx, BRepMesh_Frontier);
44     anIndexes.ChangeValue (aPtIdx - aPtsLower) = aMeshStructure->AddNode (aVertex);
45   }
46
47   Standard_Real aPtSum = 0;
48   for (Standard_Integer aIdx = aPtsLower; aIdx <= aPtsUpper; ++aIdx)
49   {
50     Standard_Integer aNextIdx = (aIdx % thePoints.Length()) + 1;
51     aPtSum += (thePoints.Value (aNextIdx).Coord().X() - thePoints.Value (aIdx).Coord().X())
52               * (thePoints.Value (aNextIdx).Coord().Y() + thePoints.Value (aIdx).Coord().Y());
53   }
54   Standard_Boolean isClockwiseOrdered = aPtSum < 0;
55
56   for (Standard_Integer aIdx = 0; aIdx < anIndexes.Length(); ++aIdx)
57   {
58     Standard_Integer aPtIdx = isClockwiseOrdered ? aIdx : (aIdx + 1) % anIndexes.Length();
59     Standard_Integer aNextPtIdx = isClockwiseOrdered ? (aIdx + 1) % anIndexes.Length() : aIdx;
60     BRepMesh_Edge anEdge (anIndexes.Value (aPtIdx),
61                           anIndexes.Value (aNextPtIdx),
62                           BRepMesh_Frontier);
63     aMeshStructure->AddLink (anEdge);
64   }
65
66   BRepMesh_Delaun aTriangulation (aMeshStructure, anIndexes);
67   const BRepMesh::MapOfInteger& aTriangles = aMeshStructure->ElementsOfDomain();
68   if (aTriangles.Extent() < 1)
69     return;
70
71   BRepMesh::MapOfInteger::Iterator aTriangleIt (aTriangles);
72   for (; aTriangleIt.More(); aTriangleIt.Next())
73   {
74     const Standard_Integer aTriangleId = aTriangleIt.Key();
75     const BRepMesh_Triangle& aCurrentTriangle = aMeshStructure->GetElement (aTriangleId);
76
77     if (aCurrentTriangle.Movability() == BRepMesh_Deleted)
78       continue;
79
80     Standard_Integer aTriangleVerts[3];
81     aMeshStructure->ElementNodes (aCurrentTriangle, aTriangleVerts);
82
83     gp_Pnt2d aPts[3];
84     for (Standard_Integer aVertIdx = 0; aVertIdx < 3; ++aVertIdx)
85     {
86       const BRepMesh_Vertex& aVertex = aMeshStructure->GetNode (aTriangleVerts[aVertIdx]);
87       aPts[aVertIdx] = aVertex.Coord();
88     }
89
90     Handle(SelectMgr_TriangularFrustum) aTrFrustum = new SelectMgr_TriangularFrustum();
91     aTrFrustum->SetBuilder (myBuilder);
92     aTrFrustum->Build (aPts[0], aPts[1], aPts[2]);
93     myFrustums.Append (aTrFrustum);
94   }
95
96   aMeshStructure.Nullify();
97   anAllocator.Nullify();
98 }
99
100 // =======================================================================
101 // function : ScaleAndTransform
102 // purpose  : IMPORTANT: Scaling makes sense only for frustum built on a single point!
103 //            Note that this method does not perform any checks on type of the frustum.
104 //            Returns a copy of the frustum resized according to the scale factor given
105 //            and transforms it using the matrix given.
106 //            There are no default parameters, but in case if:
107 //                - transformation only is needed: @theScaleFactor must be initialized
108 //                  as any negative value;
109 //                - scale only is needed: @theTrsf must be set to gp_Identity.
110 // =======================================================================
111 Handle(SelectMgr_BaseFrustum) SelectMgr_TriangularFrustumSet::ScaleAndTransform (const Standard_Integer theScale,
112                                                                                  const gp_GTrsf& theTrsf) const
113 {
114   Handle(SelectMgr_TriangularFrustumSet) aRes = new SelectMgr_TriangularFrustumSet();
115
116   for (SelectMgr_TriangFrustumsIter anIter (myFrustums); anIter.More(); anIter.Next())
117   {
118     aRes->myFrustums.Append (Handle(SelectMgr_TriangularFrustum)::DownCast (anIter.Value()->ScaleAndTransform (theScale, theTrsf)));
119   }
120
121   return aRes;
122 }
123
124 // =======================================================================
125 // function : Overlaps
126 // purpose  :
127 // =======================================================================
128 Standard_Boolean SelectMgr_TriangularFrustumSet::Overlaps (const SelectMgr_Vec3& theMinPnt,
129                                                            const SelectMgr_Vec3& theMaxPnt,
130                                                            SelectBasics_PickResult& thePickResult)
131 {
132   for (SelectMgr_TriangFrustumsIter anIter (myFrustums); anIter.More(); anIter.Next())
133   {
134     if (anIter.Value()->Overlaps (theMinPnt, theMaxPnt, thePickResult))
135       return Standard_True;
136   }
137
138   return Standard_False;
139 }
140
141 // =======================================================================
142 // function : Overlaps
143 // purpose  :
144 // =======================================================================
145 Standard_Boolean SelectMgr_TriangularFrustumSet::Overlaps (const SelectMgr_Vec3& theMinPnt,
146                                                            const SelectMgr_Vec3& theMaxPnt,
147                                                            Standard_Boolean* /*theInside*/)
148 {
149   for (SelectMgr_TriangFrustumsIter anIter (myFrustums); anIter.More(); anIter.Next())
150   {
151     if (anIter.Value()->Overlaps (theMinPnt, theMaxPnt, NULL))
152       return Standard_True;
153   }
154
155   return Standard_False;
156 }
157
158 // =======================================================================
159 // function : Overlaps
160 // purpose  :
161 // =======================================================================
162 Standard_Boolean SelectMgr_TriangularFrustumSet::Overlaps (const gp_Pnt& thePnt,
163                                                            SelectBasics_PickResult& thePickResult)
164 {
165   for (SelectMgr_TriangFrustumsIter anIter (myFrustums); anIter.More(); anIter.Next())
166   {
167     if (anIter.Value()->Overlaps (thePnt, thePickResult))
168       return Standard_True;
169   }
170
171   return Standard_False;
172 }
173
174 // =======================================================================
175 // function : Overlaps
176 // purpose  :
177 // =======================================================================
178 Standard_Boolean SelectMgr_TriangularFrustumSet::Overlaps (const TColgp_Array1OfPnt& theArrayOfPts,
179                                                            Select3D_TypeOfSensitivity theSensType,
180                                                            SelectBasics_PickResult& thePickResult)
181 {
182   for (SelectMgr_TriangFrustumsIter anIter (myFrustums); anIter.More(); anIter.Next())
183   {
184     if (anIter.Value()->Overlaps (theArrayOfPts, theSensType, thePickResult))
185       return Standard_True;
186   }
187
188   return Standard_False;
189 }
190
191 // =======================================================================
192 // function : Overlaps
193 // purpose  :
194 // =======================================================================
195 Standard_Boolean SelectMgr_TriangularFrustumSet::Overlaps (const gp_Pnt& thePnt1,
196                                                            const gp_Pnt& thePnt2,
197                                                            SelectBasics_PickResult& thePickResult)
198 {
199   for (SelectMgr_TriangFrustumsIter anIter (myFrustums); anIter.More(); anIter.Next())
200   {
201     if (anIter.Value()->Overlaps (thePnt1, thePnt2, thePickResult))
202       return Standard_True;
203   }
204
205   return Standard_False;
206 }
207
208 // =======================================================================
209 // function : Overlaps
210 // purpose  :
211 // =======================================================================
212 Standard_Boolean SelectMgr_TriangularFrustumSet::Overlaps (const gp_Pnt& thePnt1,
213                                                            const gp_Pnt& thePnt2,
214                                                            const gp_Pnt& thePnt3,
215                                                            Select3D_TypeOfSensitivity theSensType,
216                                                            SelectBasics_PickResult& thePickResult)
217 {
218   for (SelectMgr_TriangFrustumsIter anIter (myFrustums); anIter.More(); anIter.Next())
219   {
220     if (anIter.Value()->Overlaps (thePnt1, thePnt2, thePnt3, theSensType, thePickResult))
221       return Standard_True;
222   }
223
224   return Standard_False;
225 }
226
227 // =======================================================================
228 // function : GetPlanes
229 // purpose  :
230 // =======================================================================
231 void SelectMgr_TriangularFrustumSet::GetPlanes (NCollection_Vector<SelectMgr_Vec4>& thePlaneEquations) const
232 {
233   thePlaneEquations.Clear();
234
235   for (SelectMgr_TriangFrustumsIter anIter (myFrustums); anIter.More(); anIter.Next())
236   {
237     anIter.Value()->GetPlanes (thePlaneEquations);
238   }
239 }
240
241 #undef MEMORY_BLOCK_SIZE