1 // Created on: 2014-11-21
2 // Created by: Varvara POSKONINA
3 // Copyright (c) 2005-2014 OPEN CASCADE SAS
5 // This file is part of Open CASCADE Technology software library.
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.
13 // Alternatively, this file may be used under the terms of Open CASCADE
14 // commercial license or contractual agreement.
16 #include <SelectMgr_TriangularFrustum.hxx>
18 IMPLEMENT_STANDARD_RTTIEXT(SelectMgr_TriangularFrustum,Standard_Transient)
20 SelectMgr_TriangularFrustum::~SelectMgr_TriangularFrustum()
27 void computeFrustumNormals (const gp_Vec* theEdges, gp_Vec* theNormals)
30 theNormals[0] = theEdges[0].Crossed (theEdges[3]);
32 theNormals[1] = theEdges[1].Crossed (theEdges[4]);
34 theNormals[2] = theEdges[0].Crossed (theEdges[5]);
36 theNormals[3] = theEdges[3].Crossed (theEdges[4]);
38 theNormals[4] = -theNormals[3];
42 // =======================================================================
43 // function : cacheVertexProjections
44 // purpose : Caches projection of frustum's vertices onto its plane directions
46 // =======================================================================
47 void SelectMgr_TriangularFrustum::cacheVertexProjections (SelectMgr_TriangularFrustum* theFrustum) const
49 for (Standard_Integer aPlaneIdx = 0; aPlaneIdx < 5; ++aPlaneIdx)
51 Standard_Real aMax = -DBL_MAX;
52 Standard_Real aMin = DBL_MAX;
53 const gp_XYZ& aPlane = theFrustum->myPlanes[aPlaneIdx].XYZ();
54 for (Standard_Integer aVertIdx = 0; aVertIdx < 6; ++aVertIdx)
56 Standard_Real aProjection = aPlane.Dot (theFrustum->myVertices[aVertIdx].XYZ());
57 aMax = Max (aMax, aProjection);
58 aMin = Min (aMin, aProjection);
60 theFrustum->myMaxVertsProjections[aPlaneIdx] = aMax;
61 theFrustum->myMinVertsProjections[aPlaneIdx] = aMin;
64 for (Standard_Integer aDim = 0; aDim < 3; ++aDim)
66 Standard_Real aMax = -DBL_MAX;
67 Standard_Real aMin = DBL_MAX;
68 for (Standard_Integer aVertIdx = 0; aVertIdx < 6; ++aVertIdx)
70 Standard_Real aProjection = theFrustum->myVertices[aVertIdx].XYZ().GetData()[aDim];
71 aMax = Max (aMax, aProjection);
72 aMin = Min (aMin, aProjection);
74 theFrustum->myMaxOrthoVertsProjections[aDim] = aMax;
75 theFrustum->myMinOrthoVertsProjections[aDim] = aMin;
79 //=======================================================================
80 // function : SelectMgr_TriangularFrustum
81 // purpose : Creates new triangular frustum with bases of triangles with
82 // vertices theP1, theP2 and theP3 projections onto near and
83 // far view frustum planes
84 //=======================================================================
85 void SelectMgr_TriangularFrustum::Build (const gp_Pnt2d& theP1,
86 const gp_Pnt2d& theP2,
87 const gp_Pnt2d& theP3)
90 myVertices[0] = myBuilder->ProjectPntOnViewPlane (theP1.X(), theP1.Y(), 0.0);
92 myVertices[1] = myBuilder->ProjectPntOnViewPlane (theP2.X(), theP2.Y(), 0.0);
94 myVertices[2] = myBuilder->ProjectPntOnViewPlane (theP3.X(), theP3.Y(), 0.0);
96 myVertices[3] = myBuilder->ProjectPntOnViewPlane (theP1.X(), theP1.Y(), 1.0);
98 myVertices[4] = myBuilder->ProjectPntOnViewPlane (theP2.X(), theP2.Y(), 1.0);
100 myVertices[5] = myBuilder->ProjectPntOnViewPlane (theP3.X(), theP3.Y(), 1.0);
103 myEdgeDirs[0] = myVertices[0].XYZ() - myVertices[3].XYZ();
105 myEdgeDirs[1] = myVertices[1].XYZ() - myVertices[4].XYZ();
107 myEdgeDirs[2] = myVertices[2].XYZ() - myVertices[5].XYZ();
109 myEdgeDirs[3] = myVertices[1].XYZ() - myVertices[0].XYZ();
111 myEdgeDirs[4] = myVertices[2].XYZ() - myVertices[1].XYZ();
113 myEdgeDirs[5] = myVertices[2].XYZ() - myVertices[0].XYZ();
115 computeFrustumNormals (myEdgeDirs, myPlanes);
117 cacheVertexProjections (this);
120 //=======================================================================
121 // function : ScaleAndTransform
122 // purpose : IMPORTANT: Scaling makes sense only for frustum built on a single point!
123 // Note that this method does not perform any checks on type of the frustum.
124 // Returns a copy of the frustum resized according to the scale factor given
125 // and transforms it using the matrix given.
126 // There are no default parameters, but in case if:
127 // - transformation only is needed: @theScaleFactor must be initialized
128 // as any negative value;
129 // - scale only is needed: @theTrsf must be set to gp_Identity.
130 //=======================================================================
131 Handle(SelectMgr_BaseFrustum) SelectMgr_TriangularFrustum::ScaleAndTransform (const Standard_Integer /*theScale*/,
132 const gp_GTrsf& theTrsf) const
134 Handle(SelectMgr_TriangularFrustum) aRes = new SelectMgr_TriangularFrustum();
136 for (Standard_Integer anIt = 0; anIt < 6; anIt++)
138 gp_Pnt aPoint = myVertices[anIt];
139 theTrsf.Transforms (aPoint.ChangeCoord());
140 aRes->myVertices[anIt] = aPoint;
143 aRes->myIsOrthographic = myIsOrthographic;
146 aRes->myEdgeDirs[0] = aRes->myVertices[0].XYZ() - aRes->myVertices[3].XYZ();
148 aRes->myEdgeDirs[1] = aRes->myVertices[1].XYZ() - aRes->myVertices[4].XYZ();
150 aRes->myEdgeDirs[2] = aRes->myVertices[2].XYZ() - aRes->myVertices[5].XYZ();
152 aRes->myEdgeDirs[3] = aRes->myVertices[1].XYZ() - aRes->myVertices[0].XYZ();
154 aRes->myEdgeDirs[4] = aRes->myVertices[2].XYZ() - aRes->myVertices[1].XYZ();
156 aRes->myEdgeDirs[5] = aRes->myVertices[2].XYZ() - aRes->myVertices[0].XYZ();
158 computeFrustumNormals (aRes->myEdgeDirs, aRes->myPlanes);
160 cacheVertexProjections (aRes.get());
165 //=======================================================================
166 // function : Overlaps
167 // purpose : SAT intersection test between defined volume and
168 // given axis-aligned box
169 //=======================================================================
170 Standard_Boolean SelectMgr_TriangularFrustum::Overlaps (const SelectMgr_Vec3& theMinPt,
171 const SelectMgr_Vec3& theMaxPt,
172 const SelectMgr_ViewClipRange& /*theClipRange*/,
173 SelectBasics_PickResult& /*thePickResult*/) const
175 return hasOverlap (theMinPt, theMaxPt);
178 // =======================================================================
179 // function : Overlaps
180 // purpose : Returns true if selecting volume is overlapped by
181 // axis-aligned bounding box with minimum corner at point
182 // theMinPt and maximum at point theMaxPt
183 // =======================================================================
184 Standard_Boolean SelectMgr_TriangularFrustum::Overlaps (const SelectMgr_Vec3& theMinPt,
185 const SelectMgr_Vec3& theMaxPt,
186 Standard_Boolean* /*theInside*/) const
188 return hasOverlap (theMinPt, theMaxPt, NULL);
191 // =======================================================================
192 // function : Overlaps
193 // purpose : Intersection test between defined volume and given point
194 // =======================================================================
195 Standard_Boolean SelectMgr_TriangularFrustum::Overlaps (const gp_Pnt& thePnt,
196 const SelectMgr_ViewClipRange& /*theClipRange*/,
197 SelectBasics_PickResult& /*thePickResult*/) const
199 return hasOverlap (thePnt);
202 // =======================================================================
203 // function : Overlaps
204 // purpose : SAT intersection test between defined volume and given
205 // ordered set of points, representing line segments. The test
206 // may be considered of interior part or boundary line defined
207 // by segments depending on given sensitivity type
208 // =======================================================================
209 Standard_Boolean SelectMgr_TriangularFrustum::Overlaps (const TColgp_Array1OfPnt& theArrayOfPnts,
210 Select3D_TypeOfSensitivity theSensType,
211 const SelectMgr_ViewClipRange& /*theClipRange*/,
212 SelectBasics_PickResult& /*thePickResult*/) const
214 if (theSensType == Select3D_TOS_BOUNDARY)
216 const Standard_Integer aLower = theArrayOfPnts.Lower();
217 const Standard_Integer anUpper = theArrayOfPnts.Upper();
218 for (Standard_Integer aPtIdx = aLower; aPtIdx <= anUpper; ++aPtIdx)
220 const gp_Pnt& aStartPt = theArrayOfPnts.Value (aPtIdx);
221 const gp_Pnt& aEndPt = theArrayOfPnts.Value (aPtIdx == anUpper ? aLower : (aPtIdx + 1));
222 if (!hasOverlap (aStartPt, aEndPt))
224 return Standard_False;
228 else if (theSensType == Select3D_TOS_INTERIOR)
230 gp_Vec aNorm (gp_XYZ (RealLast(), RealLast(), RealLast()));
231 return hasOverlap (theArrayOfPnts, aNorm);
234 return Standard_False;
237 // =======================================================================
238 // function : Overlaps
239 // purpose : Checks if line segment overlaps selecting frustum
240 // =======================================================================
241 Standard_Boolean SelectMgr_TriangularFrustum::Overlaps (const gp_Pnt& thePnt1,
242 const gp_Pnt& thePnt2,
243 const SelectMgr_ViewClipRange& /*theClipRange*/,
244 SelectBasics_PickResult& /*thePickResult*/) const
246 return hasOverlap (thePnt1, thePnt2);
249 // =======================================================================
250 // function : Overlaps
251 // purpose : SAT intersection test between defined volume and given
252 // triangle. The test may be considered of interior part or
253 // boundary line defined by triangle vertices depending on
254 // given sensitivity type
255 // =======================================================================
256 Standard_Boolean SelectMgr_TriangularFrustum::Overlaps (const gp_Pnt& thePnt1,
257 const gp_Pnt& thePnt2,
258 const gp_Pnt& thePnt3,
259 Select3D_TypeOfSensitivity theSensType,
260 const SelectMgr_ViewClipRange& theClipRange,
261 SelectBasics_PickResult& thePickResult) const
263 if (theSensType == Select3D_TOS_BOUNDARY)
265 const gp_Pnt aPntsArrayBuf[3] = { thePnt1, thePnt2, thePnt3 };
266 const TColgp_Array1OfPnt aPntsArray (aPntsArrayBuf[0], 1, 3);
267 return Overlaps (aPntsArray, Select3D_TOS_BOUNDARY, theClipRange, thePickResult);
269 else if (theSensType == Select3D_TOS_INTERIOR)
271 gp_Vec aNorm (gp_XYZ (RealLast(), RealLast(), RealLast()));
272 return hasOverlap (thePnt1, thePnt2, thePnt3, aNorm);
275 return Standard_True;
278 // =======================================================================
280 // purpose : Nullifies the handle for corresponding builder instance to prevent
282 // =======================================================================
283 void SelectMgr_TriangularFrustum::Clear()
288 // =======================================================================
289 // function : GetPlanes
291 // =======================================================================
292 void SelectMgr_TriangularFrustum::GetPlanes (NCollection_Vector<SelectMgr_Vec4>& thePlaneEquations) const
294 SelectMgr_Vec4 aPlaneEquation;
295 for (Standard_Integer aPlaneIdx = 0; aPlaneIdx < 5; ++aPlaneIdx)
297 const gp_Vec& aNorm = myPlanes[aPlaneIdx];
298 aPlaneEquation.x() = aNorm.X();
299 aPlaneEquation.y() = aNorm.Y();
300 aPlaneEquation.z() = aNorm.Z();
301 aPlaneEquation.w() = - (aNorm.XYZ().Dot (myVertices[aPlaneIdx % 2 == 0 ? aPlaneIdx : 1].XYZ()));
302 thePlaneEquations.Append (aPlaneEquation);