1 // Copyright (C) 2007-2011 CEA/DEN, EDF R&D, OPEN CASCADE
3 // Copyright (C) 2003-2007 OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
4 // CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS
6 // This library is free software; you can redistribute it and/or
7 // modify it under the terms of the GNU Lesser General Public
8 // License as published by the Free Software Foundation; either
9 // version 2.1 of the License.
11 // This library is distributed in the hope that it will be useful,
12 // but WITHOUT ANY WARRANTY; without even the implied warranty of
13 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 // Lesser General Public License for more details.
16 // You should have received a copy of the GNU Lesser General Public
17 // License along with this library; if not, write to the Free Software
18 // Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 // See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
22 // File: GEOMAlgo_GetInPlace_1.cxx
24 // Author: Peter KURNEV
26 #include <GEOMAlgo_GetInPlace.hxx>
32 #include <gp_Pnt2d.hxx>
33 #include <gp_Dir2d.hxx>
35 #include <Geom_Surface.hxx>
36 #include <Geom2d_Curve.hxx>
37 #include <Geom2d_Line.hxx>
38 #include <Geom2d_TrimmedCurve.hxx>
39 #include <Geom2dAdaptor_Curve.hxx>
40 #include <Geom2dHatch_Hatcher.hxx>
41 #include <Geom2dHatch_Intersector.hxx>
42 #include <HatchGen_Domain.hxx>
43 #include <GeomAPI_ProjectPointOnCurve.hxx>
45 #include <TopAbs_State.hxx>
46 #include <TopAbs_ShapeEnum.hxx>
47 #include <TopAbs_Orientation.hxx>
49 #include <TopoDS_Vertex.hxx>
50 #include <TopoDS_Edge.hxx>
51 #include <TopoDS_Solid.hxx>
52 #include <TopoDS_Face.hxx>
54 #include <BRep_Tool.hxx>
55 #include <TopExp_Explorer.hxx>
57 #include <BRepTools.hxx>
58 #include <BRepClass3d_SolidClassifier.hxx>
60 #include <IntTools_Tools.hxx>
62 #include <BOPTools_Tools3D.hxx>
63 #include <BOPTools_Tools2D.hxx>
68 Standard_Integer PntInEdge(const TopoDS_Edge& aF,
71 Standard_Integer PntInEdge(const TopoDS_Edge& aF,
75 Standard_Integer PntInFace(const TopoDS_Face& aF,
78 Standard_Integer PntInFace(const TopoDS_Face& aF,
82 Standard_Integer PntInSolid(const TopoDS_Solid& aZ,
83 const Standard_Real aTol,
87 //=======================================================================
88 //function : CheckCoincidence
90 //=======================================================================
91 Standard_Boolean GEOMAlgo_GetInPlace::CheckCoincidence(const TopoDS_Shape& aS1,
92 const TopoDS_Shape& aS2)
94 Standard_Boolean bOk, bIsDone;
95 Standard_Integer iErr;
96 Standard_Real aTol2, aD2;
97 TopAbs_ShapeEnum aType1, aType2;
105 aTol2=myTolerance*myTolerance;
106 aType1=aS1.ShapeType();
107 aType2=aS2.ShapeType();
109 // 1. A point on shape #2 -> aP2
110 if (myMapShapePnt.IsBound(aS2)) {
111 aP2=myMapShapePnt.Find(aS2);
114 if (aType2==TopAbs_VERTEX) {
115 const TopoDS_Vertex& aV2=*((TopoDS_Vertex*)&aS2);
116 aP2=BRep_Tool::Pnt(aV2);
119 else if (aType2==TopAbs_EDGE) {
120 const TopoDS_Edge& aE2=*((TopoDS_Edge*)&aS2);
121 iErr=PntInEdge(aE2, aP2);
124 else if (aType2==TopAbs_FACE) {
125 const TopoDS_Face& aF2=*((TopoDS_Face*)&aS2);
126 iErr=PntInFace(aF2, aP2);
129 else if (aType2==TopAbs_SOLID) {
130 const TopoDS_Solid& aZ2=*((TopoDS_Solid*)&aS2);
131 iErr=PntInSolid(aZ2, myTolerance, aP2);
143 myMapShapePnt.Bind(aS2, aP2);
146 // 2. Project the point aP2 on shape #1 and check
147 if (aType1==TopAbs_EDGE) {
148 Standard_Integer aNbPoints;
149 Standard_Real aDmin, aT, aT1, aT2, dT;
151 const TopoDS_Edge& aE1=*((TopoDS_Edge*)&aS1);
153 GeomAPI_ProjectPointOnCurve& aPPC=myContext.ProjPC(aE1);
155 aNbPoints=aPPC.NbPoints();
157 aDmin=aPPC.LowerDistance();
158 aT=aPPC.LowerDistanceParameter();
159 if (aDmin < myTolerance) {
161 BRep_Tool::Curve(aE1, aT1, aT2);
162 if(aT > (aT1-dT) && aT < (aT2+dT)) {
170 }//if (aType1==TopAbs_EDGE) {
172 else if (aType1==TopAbs_FACE) {
173 const TopoDS_Face& aF1=*((TopoDS_Face*)&aS1);
175 bOk=myContext.IsValidPointForFace(aP2, aF1, myTolerance);
178 else if (aType1==TopAbs_SOLID) {
179 const TopoDS_Solid& aZ1=*((TopoDS_Solid*)&aS1);
181 BRepClass3d_SolidClassifier& aSC=myContext.SolidClassifier(aZ1);
182 aSC.Perform(aP2, myTolerance);
184 bOk=(aState==TopAbs_IN);
193 //=======================================================================
195 //=======================================================================
196 //function : PntInEdge
198 //=======================================================================
199 Standard_Integer PntInEdge(const TopoDS_Edge& aE,
203 Standard_Integer iErr;
206 iErr=PntInEdge(aE, aP, aT);
210 //=======================================================================
211 //function : PntInEdge
213 //=======================================================================
214 Standard_Integer PntInEdge(const TopoDS_Edge& aE,
218 Standard_Integer iErr;
219 Standard_Real aT1, aT2;
220 Handle(Geom_Curve) aC3D;
224 aC3D=BRep_Tool::Curve(aE, aT1, aT2);
225 aT=IntTools_Tools::IntermediatePoint(aT1, aT2);
230 //=======================================================================
231 //function : PntInSolid
233 //=======================================================================
234 Standard_Integer PntInSolid(const TopoDS_Solid& aZ,
235 const Standard_Real aTol,
238 Standard_Integer iErr;
239 Standard_Real aUx, aVx, aCoef;
245 TopExp_Explorer aExp;
250 aExp.Init (aZ, TopAbs_FACE);
251 for (; aExp.More() ; aExp.Next()) {
252 aF=*((TopoDS_Face*)&aExp.Current());
256 iErr=PntInFace(aF, aPx, aP2Dx);
261 aP2Dx.Coord(aUx, aVx);
262 BOPTools_Tools2D::FaceNormal(aF, aUx, aVx, aDNx);
265 aP.SetXYZ(aPx.XYZ()+aCoef*aTol*aDNx.XYZ());
269 //=======================================================================
270 //function : PntInFace
272 //=======================================================================
273 Standard_Integer PntInFace(const TopoDS_Face& aF,
276 Standard_Integer iErr;
280 iErr=PntInFace(aF, aP, aP2Dx);
284 //=======================================================================
285 //function : PntInFace
287 //=======================================================================
288 Standard_Integer PntInFace(const TopoDS_Face& aF,
292 Standard_Boolean bIsDone, bHasFirstPoint, bHasSecondPoint;
293 Standard_Integer iErr, aIx, aNbDomains, i;
294 Standard_Real aUMin, aUMax, aVMin, aVMax;
295 Standard_Real aVx, aUx, aV1, aV2, aU1, aU2, aEpsT;
296 Standard_Real aTotArcIntr, aTolTangfIntr, aTolHatch2D, aTolHatch3D;
297 gp_Dir2d aD2D (0., 1.);
300 Handle(Geom2d_Curve) aC2D;
301 Handle(Geom2d_TrimmedCurve) aCT2D;
302 Handle(Geom2d_Line) aL2D;
303 Handle(Geom_Surface) aS;
304 TopAbs_Orientation aOrE;
306 TopExp_Explorer aExp;
311 aTolTangfIntr=1.e-10;
313 Geom2dHatch_Intersector aIntr(aTotArcIntr, aTolTangfIntr);
314 Geom2dHatch_Hatcher aHatcher(aIntr,
315 aTolHatch2D, aTolHatch3D,
316 Standard_True, Standard_False);
322 aFF.Orientation (TopAbs_FORWARD);
324 aS=BRep_Tool::Surface(aFF);
325 BRepTools::UVBounds(aFF, aUMin, aUMax, aVMin, aVMax);
328 aExp.Init (aFF, TopAbs_EDGE);
329 for (; aExp.More() ; aExp.Next()) {
330 const TopoDS_Edge& aE=*((TopoDS_Edge*)&aExp.Current());
331 aOrE=aE.Orientation();
333 aC2D=BRep_Tool::CurveOnSurface (aE, aFF, aU1, aU2);
334 if (aC2D.IsNull() ) {
338 if (fabs(aU1-aU2) < aEpsT) {
343 aCT2D=new Geom2d_TrimmedCurve(aC2D, aU1, aU2);
344 aHatcher.AddElement(aCT2D, aOrE);
345 }// for (; aExp.More() ; aExp.Next()) {
348 aUx=IntTools_Tools::IntermediatePoint(aUMin, aUMax);
349 aP2D.SetCoord(aUx, 0.);
350 aL2D=new Geom2d_Line (aP2D, aD2D);
351 Geom2dAdaptor_Curve aHCur(aL2D);
353 aIx=aHatcher.AddHatching(aHCur) ;
357 bIsDone=aHatcher.TrimDone(aIx);
363 aHatcher.ComputeDomains(aIx);
364 bIsDone=aHatcher.IsDone(aIx);
371 aNbDomains=aHatcher.NbDomains(aIx);
372 for (i=1; i<=aNbDomains; ++i) {
373 const HatchGen_Domain& aDomain=aHatcher.Domain (aIx, i) ;
374 bHasFirstPoint=aDomain.HasFirstPoint();
375 if (!bHasFirstPoint) {
380 aV1=aDomain.FirstPoint().Parameter();
382 bHasSecondPoint=aDomain.HasSecondPoint();
383 if (!bHasSecondPoint) {
388 aV2=aDomain.SecondPoint().Parameter();
390 aVx=IntTools_Tools::IntermediatePoint(aV1, aV2);
395 aS->D0(aUx, aVx, aPx);
397 theP2D.SetCoord(aUx, aVx);