1 // Created on: 2012-08-06
2 // Created by: jgv@ROLEX
3 // Copyright (c) 2012-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 <BRepOffsetAPI_MiddlePath.ixx>
17 #include <BRepOffsetAPI_MiddlePath.hxx>
19 #include <ShapeUpgrade_UnifySameDomain.hxx>
22 #include <Geom_Curve.hxx>
23 #include <Geom_TrimmedCurve.hxx>
24 #include <Geom_Line.hxx>
25 #include <Geom_BezierCurve.hxx>
26 #include <Geom_BSplineCurve.hxx>
27 #include <BRep_Tool.hxx>
28 #include <gce_MakeLin.hxx>
30 #include <BRepLib_MakeWire.hxx>
32 #include <TopTools_IndexedDataMapOfShapeListOfShape.hxx>
33 #include <TopTools_MapIteratorOfMapOfShape.hxx>
35 #include <TopTools_ListIteratorOfListOfShape.hxx>
37 #include <BRepTools.hxx>
38 #include <TopTools_SequenceOfShape.hxx>
39 #include <BRepTools_WireExplorer.hxx>
40 #include <TopoDS_Iterator.hxx>
41 #include <BRep_Builder.hxx>
42 #include <Precision.hxx>
43 #include <TopExp_Explorer.hxx>
44 #include <BRepExtrema_DistShapeShape.hxx>
45 #include <Geom2d_Curve.hxx>
46 #include <Geom2d_Line.hxx>
47 #include <GCE2d_MakeLine.hxx>
48 #include <BRepLib_MakeEdge.hxx>
49 #include <BRepLib.hxx>
50 #include <GeomAbs_CurveType.hxx>
51 #include <BRepAdaptor_Curve.hxx>
52 #include <TopTools_Array1OfShape.hxx>
53 #include <BRepLib_MakeFace.hxx>
54 #include <TColgp_Array1OfPnt.hxx>
55 #include <TColgp_HArray1OfPnt.hxx>
56 #include <TColgp_Array1OfVec.hxx>
57 #include <TColStd_HArray1OfBoolean.hxx>
58 #include <GProp_GProps.hxx>
59 #include <BRepGProp.hxx>
60 #include <Geom_Circle.hxx>
61 #include <gp_Circ.hxx>
62 #include <GC_MakeCircle.hxx>
63 #include <TColgp_SequenceOfPnt.hxx>
64 #include <GeomLib.hxx>
65 #include <GeomAPI_Interpolate.hxx>
67 static Standard_Boolean IsLinear(const TopoDS_Edge& anEdge,
70 Standard_Real fpar, lpar;
71 Handle(Geom_Curve) aCurve = BRep_Tool::Curve(anEdge, fpar, lpar);
72 if (aCurve->IsInstance(STANDARD_TYPE(Geom_TrimmedCurve)))
73 aCurve = ((Handle(Geom_TrimmedCurve)&) aCurve)->BasisCurve();
76 if (aCurve->IsKind(STANDARD_TYPE(Geom_Line)))
78 aLine = ((Handle(Geom_Line)&) aCurve)->Lin();
81 else if (aCurve->IsKind(STANDARD_TYPE(Geom_BezierCurve)))
83 Handle(Geom_BezierCurve) theBezier = (Handle(Geom_BezierCurve)&) aCurve;
84 if (theBezier->NbPoles() == 2)
86 Pnt1 = theBezier->Pole(1);
87 Pnt2 = theBezier->Pole(2);
88 aLine = gce_MakeLin(Pnt1, Pnt2);
92 else if (aCurve->IsKind(STANDARD_TYPE(Geom_BSplineCurve)))
94 Handle(Geom_BSplineCurve) theBSpline = (Handle(Geom_BSplineCurve)&) aCurve;
95 if (theBSpline->NbPoles() == 2)
97 Pnt1 = theBSpline->Pole(1);
98 Pnt2 = theBSpline->Pole(2);
99 aLine = gce_MakeLin(Pnt1, Pnt2);
100 return Standard_True;
104 return Standard_False;
107 static GeomAbs_CurveType TypeOfEdge(const TopoDS_Edge& anEdge)
110 if (IsLinear(anEdge, aLin))
113 BRepAdaptor_Curve BAcurve(anEdge);
114 return BAcurve.GetType();
117 static gp_Vec TangentOfEdge(const TopoDS_Shape& aShape,
118 const Standard_Boolean OnFirst)
120 TopoDS_Edge anEdge = TopoDS::Edge(aShape);
121 TopAbs_Orientation anOr = anEdge.Orientation();
123 Standard_Real fpar, lpar;
124 Handle(Geom_Curve) aCurve = BRep_Tool::Curve(anEdge, fpar, lpar);
125 Standard_Real thePar;
127 thePar = (anOr == TopAbs_FORWARD)? fpar : lpar;
129 thePar = (anOr == TopAbs_FORWARD)? lpar : fpar;
133 aCurve->D1(thePar, thePoint, theTangent);
134 if (anOr == TopAbs_REVERSED)
135 theTangent.Reverse();
141 static Standard_Boolean IsValidEdge(const TopoDS_Edge& theEdge,
142 const TopoDS_Face& theFace)
144 TopoDS_Vertex V1, V2;
145 TopExp::Vertices(theEdge, V1, V2);
147 Standard_Real Tol = Precision::Confusion();
150 TopExp_Explorer Explo(theFace, TopAbs_EDGE);
151 for (; Explo.More(); Explo.Next())
153 const TopoDS_Shape& anEdge = Explo.Current();
154 BRepExtrema_DistShapeShape DistMini(theEdge, anEdge);
155 if (DistMini.Value() <= Tol)
157 for (i = 1; i <= DistMini.NbSolution(); i++)
159 BRepExtrema_SupportType theType = DistMini.SupportTypeShape2(i);
160 if (theType == BRepExtrema_IsOnEdge)
161 return Standard_False;
162 //theType is "IsVertex"
163 TopoDS_Shape aVertex = DistMini.SupportOnShape2(i);
164 if (!(aVertex.IsSame(V1) || aVertex.IsSame(V2)))
165 return Standard_False;
170 return Standard_True;
174 //=======================================================================
175 //function : BRepOffsetAPI_MiddlePath
176 //purpose : Constructor
177 //=======================================================================
179 BRepOffsetAPI_MiddlePath::BRepOffsetAPI_MiddlePath(const TopoDS_Shape& aShape,
180 const TopoDS_Wire& StartWire)
182 myInitialShape = aShape;
183 myStartWire = StartWire;
184 myClosedSection = myStartWire.Closed();
187 //=======================================================================
188 //function : BRepOffsetAPI_MiddlePath
189 //purpose : Constructor
190 //=======================================================================
192 BRepOffsetAPI_MiddlePath::BRepOffsetAPI_MiddlePath(const TopoDS_Shape& aShape,
193 const TopoDS_Edge& StartEdge)
195 myInitialShape = aShape;
197 BRepLib_MakeWire MW(StartEdge);
199 //BB.Add(myStartWire, StartEdge);
201 TopTools_IndexedDataMapOfShapeListOfShape EFmap;
202 TopTools_IndexedDataMapOfShapeListOfShape VEmap;
203 TopExp::MapShapesAndAncestors(myInitialShape, TopAbs_EDGE, TopAbs_FACE, EFmap);
204 TopExp::MapShapesAndAncestors(myInitialShape, TopAbs_VERTEX, TopAbs_EDGE, VEmap);
206 //Standard_Boolean Start = Standard_True;
209 //TopExp::Vertices(CurEdge, V1, V2);
212 // if (VEmap(CurVertex).Extent() == 2) //end: two free edges
216 // if (VEmap(CurVertex).Extent() == 2) //end: two free edges
219 // Start = Standard_False;
223 TopoDS_Vertex StartVertex, CurVertex, V1, V2;
224 TopExp::Vertices(StartEdge, StartVertex, CurVertex);
225 TopoDS_Edge CurEdge = StartEdge;
227 for (i = 1; i <= 2; i++)
231 const TopTools_ListOfShape& LE = VEmap.FindFromKey(CurVertex);
232 if (LE.Extent() == 2) //end: two free edges or one closed free edge
234 TopTools_ListIteratorOfListOfShape itl(LE);
236 for (; itl.More(); itl.Next())
238 anEdge = TopoDS::Edge(itl.Value());
239 if (anEdge.IsSame(CurEdge))
241 if (EFmap.FindFromKey(anEdge).Extent() == 1) //another free edge found
244 //BB.Add(myStartWire, anEdge);
246 TopExp::Vertices(anEdge, V1, V2);
247 CurVertex = (V1.IsSame(CurVertex))? V2 : V1;
249 if (CurVertex.IsSame(StartVertex))
252 if (CurVertex.IsSame(StartVertex))
254 CurVertex = StartVertex;
258 myStartWire = MW.Wire();
259 myClosedSection = myStartWire.Closed();
263 //=======================================================================
264 //function : BRepOffsetAPI_MiddlePath
265 //purpose : Constructor
266 //=======================================================================
268 BRepOffsetAPI_MiddlePath::BRepOffsetAPI_MiddlePath(const TopoDS_Shape& aShape,
269 const TopoDS_Shape& StartShape,
270 const TopoDS_Shape& EndShape)
272 ShapeUpgrade_UnifySameDomain Unifier(aShape);
274 myInitialShape = Unifier.Shape();
276 TopoDS_Wire aStartWire, anEndWire;
277 if (StartShape.ShapeType() == TopAbs_FACE)
279 const TopoDS_Face& StartFace = TopoDS::Face(StartShape);
280 aStartWire = BRepTools::OuterWire(StartFace);
283 aStartWire = TopoDS::Wire(StartShape);
285 if (EndShape.ShapeType() == TopAbs_FACE)
287 const TopoDS_Face& EndFace = TopoDS::Face(EndShape);
288 anEndWire = BRepTools::OuterWire(EndFace);
291 anEndWire = TopoDS::Wire(EndShape);
293 BRepLib_MakeWire MWstart;
294 //TopTools_MapOfShape MapEdges;
295 BRepTools_WireExplorer wexp(aStartWire);
296 for (; wexp.More(); wexp.Next())
298 TopoDS_Shape anEdge = wexp.Current();
299 TopoDS_Shape NewEdge = Unifier.Generated(anEdge);
300 if (!NewEdge.IsNull())
301 MWstart.Add(TopoDS::Edge(NewEdge));
303 myStartWire = MWstart.Wire();
305 BRepLib_MakeWire MWend;
307 for (wexp.Init(anEndWire); wexp.More(); wexp.Next())
309 TopoDS_Shape anEdge = wexp.Current();
310 TopoDS_Shape NewEdge = Unifier.Generated(anEdge);
311 if (!NewEdge.IsNull())
312 MWend.Add(TopoDS::Edge(NewEdge));
314 myEndWire = MWend.Wire();
316 myClosedSection = myStartWire.Closed();
317 myClosedRing = myStartWire.IsSame(myEndWire);
320 //=======================================================================
323 //=======================================================================
325 void BRepOffsetAPI_MiddlePath::Build()
327 TopTools_ListIteratorOfListOfShape itl;
329 TopTools_SequenceOfShape StartVertices;
330 TopTools_MapOfShape EndVertices;
331 TopTools_MapOfShape EndEdges;
332 BRepOffsetAPI_SequenceOfSequenceOfShape SectionsEdges;
334 BRepTools_WireExplorer wexp(myStartWire);
335 TopTools_SequenceOfShape EdgeSeq;
336 for (; wexp.More(); wexp.Next())
338 StartVertices.Append(wexp.CurrentVertex());
339 EdgeSeq.Append(wexp.Current());
341 if (!myClosedSection)
342 StartVertices.Append(wexp.CurrentVertex());
343 SectionsEdges.Append(EdgeSeq);
345 for (wexp.Init(myEndWire); wexp.More(); wexp.Next())
347 EndVertices.Add(wexp.CurrentVertex());
348 EndEdges.Add(wexp.Current());
350 if (!myClosedSection)
351 EndVertices.Add(wexp.CurrentVertex());
354 TopoDS_Iterator itw(myStartWire);
355 for (; itw.More(); itw.Next())
356 myStartWireEdges.Add(itw.Value());
357 for (itw.Initialize(myEndWire); itw.More(); itw.Next())
358 myEndWireEdges.Add(itw.Value());
360 TopTools_IndexedDataMapOfShapeListOfShape VEmap;
361 TopTools_IndexedDataMapOfShapeListOfShape EFmap;
362 TopExp::MapShapesAndAncestors(myInitialShape, TopAbs_VERTEX, TopAbs_EDGE, VEmap);
363 TopExp::MapShapesAndAncestors(myInitialShape, TopAbs_EDGE, TopAbs_FACE, EFmap);
365 TopTools_MapOfShape CurVertices;
367 Standard_Integer i, j, k;
369 TopoDS_Vertex V1, V2, NextVertex;
370 //Initialization of <myPaths>
371 for (i = 1; i <= StartVertices.Length(); i++)
373 TopTools_SequenceOfShape Edges;
374 const TopTools_ListOfShape& LE = VEmap.FindFromKey(StartVertices(i));
375 for (itl.Initialize(LE); itl.More(); itl.Next())
377 anEdge = TopoDS::Edge(itl.Value());
378 if (!myStartWireEdges.Contains(anEdge))
380 TopExp::Vertices(anEdge, V1, V2, Standard_True);
381 if (V1.IsSame(StartVertices(i)))
388 Edges.Append(anEdge);
392 myPaths.Append(Edges);
395 //Filling of "myPaths"
396 TopTools_ListOfShape NextVertices;
399 for (i = 1; i <= myPaths.Length(); i++)
401 const TopoDS_Shape& theShape = myPaths(i).Last();
403 TopoDS_Vertex theVertex;
404 if (theShape.ShapeType() == TopAbs_EDGE)
406 theEdge = TopoDS::Edge(theShape);
407 theVertex = TopExp::LastVertex(theEdge, Standard_True);
409 else //last segment of path was punctual
411 theEdge = TopoDS::Edge(myPaths(i)(myPaths(i).Length()-1));
412 theVertex = TopoDS::Vertex(theShape);
415 if (EndVertices.Contains(theVertex))
417 const TopTools_ListOfShape& LE = VEmap.FindFromKey(theVertex);
418 TopTools_MapOfShape NextEdgeCandidates;
419 for (itl.Initialize(LE); itl.More(); itl.Next())
421 anEdge = TopoDS::Edge(itl.Value());
422 if (anEdge.IsSame(theEdge))
424 TopExp::Vertices(anEdge, V1, V2, Standard_True);
425 if (V1.IsSame(theVertex))
432 if (!CurVertices.Contains(NextVertex))
433 NextEdgeCandidates.Add(anEdge);
435 if (!NextEdgeCandidates.IsEmpty())
437 if (NextEdgeCandidates.Extent() > 1)
438 myPaths(i).Append(theVertex); //punctual segment of path
441 TopTools_MapIteratorOfMapOfShape mapit(NextEdgeCandidates);
442 anEdge = TopoDS::Edge(mapit.Key());
443 myPaths(i).Append(anEdge);
444 NextVertex = TopExp::LastVertex(anEdge, Standard_True);
445 NextVertices.Append(NextVertex);
449 if (NextVertices.IsEmpty())
451 for (itl.Initialize(NextVertices); itl.More(); itl.Next())
452 CurVertices.Add(itl.Value());
453 NextVertices.Clear();
458 TopoDS_Compound aCompound, aCmp1;
460 BB.MakeCompound(aCompound);
461 BB.MakeCompound(aCmp1);
462 for (i = 1; i <= myPaths.Length(); i++)
464 TopoDS_Compound aCmp;
465 BB.MakeCompound(aCmp);
466 for (j = 1; j <= myPaths(i).Length(); j++)
467 BB.Add(aCmp, myPaths(i)(j));
470 BB.Add(aCompound, aCmp1);
479 //Building of set of sections
480 Standard_Integer NbE = EdgeSeq.Length();
481 Standard_Integer NbPaths = myPaths.Length();
482 Standard_Integer NbVer = myPaths.Length();
488 for (j = 1; j <= EdgeSeq.Length(); j++)
489 EdgeSeq(j).Nullify();
491 Standard_Boolean ToInsertVertex = Standard_False;
493 for (j = 2; j <= NbVer; j++)
495 if (!EdgeSeq(j-1).IsNull())
498 //for the end of initial shape
499 if (myPaths(j-1).Length() < i)
501 TopoDS_Edge aE1 = TopoDS::Edge(myPaths(j-1)(i-1));
502 TopoDS_Shape LastVer = TopExp::LastVertex(aE1, Standard_True);
503 myPaths(j-1).Append(LastVer);
505 if (myPaths((j<=NbPaths)? j : 1).Length() < i)
507 TopoDS_Edge aE2 = TopoDS::Edge(myPaths((j<=NbPaths)? j : 1)(i-1));
508 TopoDS_Shape LastVer = TopExp::LastVertex(aE2, Standard_True);
509 myPaths((j<=NbPaths)? j : 1).Append(LastVer);
511 //////////////////////////////
515 if (myPaths(j-1)(i).ShapeType() == TopAbs_EDGE)
517 TopoDS_Edge aE1 = TopoDS::Edge(myPaths(j-1)(i));
518 TopoDS_Shape fver = TopExp::FirstVertex(aE1, Standard_True);
519 myPaths(j-1).InsertBefore(i, fver);
521 if (myPaths((j<=NbPaths)? j : 1)(i).ShapeType() == TopAbs_EDGE)
523 TopoDS_Edge aE2 = TopoDS::Edge(myPaths((j<=NbPaths)? j : 1)(i));
524 TopoDS_Shape fver = TopExp::FirstVertex(aE2, Standard_True);
525 myPaths((j<=NbPaths)? j : 1).InsertBefore(i, fver);
527 ToInsertVertex = Standard_False;
531 if (myPaths(j-1)(i).ShapeType() == TopAbs_EDGE)
532 E1 = TopoDS::Edge(myPaths(j-1)(i));
533 if (myPaths((j<=NbPaths)? j : 1)(i).ShapeType() == TopAbs_EDGE)
534 E2 = TopoDS::Edge(myPaths((j<=NbPaths)? j : 1)(i));
535 TopoDS_Edge E12 = TopoDS::Edge(SectionsEdges(i)(j-1));
536 //Find the face on which (E1 or E2) and E12 lie
537 TopoDS_Shape E1orE2 = (E1.IsNull())? E2 : E1;
538 if (E1orE2.IsNull()) //both E1 and E2 are vertices =>
540 EdgeSeq(j-1) = E12; // => proper edge is the edge of previous section between them
543 const TopTools_ListOfShape& LF = EFmap.FindFromKey(E1orE2);
545 for (itl.Initialize(LF); itl.More(); itl.Next())
547 const TopoDS_Shape& aFace = itl.Value();
548 const TopTools_ListOfShape& LF2 = EFmap.FindFromKey(E12);
549 TopTools_ListIteratorOfListOfShape itl2(LF2);
550 for (; itl2.More(); itl2.Next())
552 const TopoDS_Shape& aFace2 = itl2.Value();
553 if (aFace.IsSame(aFace2))
555 theFace = TopoDS::Face(aFace);
559 if (!theFace.IsNull())
563 TopoDS_Vertex PrevVertex = (E1.IsNull())? TopoDS::Vertex(myPaths(j-1)(i))
564 : TopExp::LastVertex(E1, Standard_True);
565 TopoDS_Vertex CurVertex = (E2.IsNull())? TopoDS::Vertex(myPaths((j<=NbPaths)? j : 1)(i))
566 : TopExp::LastVertex(E2, Standard_True);
568 TopoDS_Edge ProperEdge;
569 const TopTools_ListOfShape& LE = VEmap.FindFromKey(PrevVertex);
571 //Standard_Integer LenList = LE.Extent();
573 TopTools_IndexedMapOfShape EdgesOfTheFace;
574 TopExp::MapShapes(theFace, TopAbs_EDGE, EdgesOfTheFace);
575 for (itl.Initialize(LE); itl.More(); itl.Next())
577 anEdge = TopoDS::Edge(itl.Value());
578 TopExp::Vertices(anEdge, V1, V2);
579 if (((V1.IsSame(PrevVertex) && V2.IsSame(CurVertex)) ||
580 (V1.IsSame(CurVertex) && V2.IsSame(PrevVertex))) &&
581 EdgesOfTheFace.Contains(anEdge) && //this condition is for a section of two edges
582 !anEdge.IsSame(E1)) //the last condition is for torus-like shape
589 if ((myPaths(j-1)(i)).ShapeType() == TopAbs_VERTEX &&
590 (myPaths((j<=NbPaths)? j : 1)(i)).ShapeType() == TopAbs_VERTEX)
592 EdgeSeq(j-1) = ProperEdge;
596 TopoDS_Vertex PrevPrevVer = (E1.IsNull())? PrevVertex
597 : TopExp::FirstVertex(E1, Standard_True);
598 TopoDS_Vertex PrevCurVer = (E2.IsNull())? CurVertex
599 : TopExp::FirstVertex(E2, Standard_True);
600 if (ProperEdge.IsNull()) //no connection between these two vertices
602 //Find the face on which E1, E2 and E12 lie
603 //ToInsertVertex = Standard_False;
604 TopTools_ListOfShape ListOneFace;
605 ListOneFace.Append(theFace);
607 if (E1.IsNull() || E2.IsNull())
610 E1 = TopoDS::Edge(myPaths(j-1)(i-1));
612 E2 = TopoDS::Edge(myPaths((j<=NbPaths)? j : 1)(i-1));
613 Standard_Real fpar1, lpar1, fpar2, lpar2;
614 Standard_Real LastPar1, LastPar2;
615 Handle(Geom2d_Curve) PCurve1 = BRep_Tool::CurveOnSurface(E1, theFace, fpar1, lpar1);
616 Handle(Geom2d_Curve) PCurve2 = BRep_Tool::CurveOnSurface(E2, theFace, fpar2, lpar2);
617 if (E1.Orientation() == TopAbs_FORWARD)
618 { LastPar1 = lpar1; }
620 { LastPar1 = fpar1; }
621 if (E2.Orientation() == TopAbs_FORWARD)
622 { LastPar2 = lpar2; }
624 { LastPar2 = fpar2; }
625 gp_Pnt2d FirstPnt2d = PCurve1->Value(LastPar1);
626 gp_Pnt2d LastPnt2d = PCurve2->Value(LastPar2);
627 Handle(Geom_Surface) theSurf = BRep_Tool::Surface(theFace);
628 Handle(Geom2d_Line) theLine = GCE2d_MakeLine(FirstPnt2d, LastPnt2d);
629 Standard_Real len_ne = FirstPnt2d.Distance(LastPnt2d);
630 TopoDS_Edge NewEdge = BRepLib_MakeEdge(theLine, theSurf,
631 PrevVertex, CurVertex,
633 BRepLib::BuildCurve3d(NewEdge);
634 EdgeSeq(j-1) = NewEdge;
635 EFmap.Add(NewEdge, ListOneFace);
640 Standard_Real fpar1, lpar1, fpar2, lpar2;
641 Standard_Real FirstPar1, LastPar1, FirstPar2, LastPar2;
642 Handle(Geom2d_Curve) PCurve1 = BRep_Tool::CurveOnSurface(E1, theFace, fpar1, lpar1);
643 Handle(Geom2d_Curve) PCurve2 = BRep_Tool::CurveOnSurface(E2, theFace, fpar2, lpar2);
644 if (E1.Orientation() == TopAbs_FORWARD)
645 { FirstPar1 = fpar1; LastPar1 = lpar1; }
647 { FirstPar1 = lpar1; LastPar1 = fpar1; }
648 if (E2.Orientation() == TopAbs_FORWARD)
649 { FirstPar2 = fpar2; LastPar2 = lpar2; }
651 { FirstPar2 = lpar2; LastPar2 = fpar2; }
652 gp_Pnt2d FirstPnt2d = PCurve1->Value(LastPar1);
653 gp_Pnt2d LastPnt2d = PCurve2->Value(LastPar2);
654 Handle(Geom_Surface) theSurf = BRep_Tool::Surface(theFace);
655 Handle(Geom2d_Line) theLine = GCE2d_MakeLine(FirstPnt2d, LastPnt2d);
656 Standard_Real len_ne = FirstPnt2d.Distance(LastPnt2d);
657 TopoDS_Edge NewEdge = BRepLib_MakeEdge(theLine, theSurf,
658 PrevVertex, CurVertex,
660 BRepLib::BuildCurve3d(NewEdge);
661 gp_Pnt2d PrevFirstPnt2d = PCurve1->Value(FirstPar1);
662 gp_Pnt2d PrevLastPnt2d = PCurve2->Value(FirstPar2);
663 Handle(Geom2d_Line) Line1 = GCE2d_MakeLine(PrevFirstPnt2d, LastPnt2d);
664 Handle(Geom2d_Line) Line2 = GCE2d_MakeLine(FirstPnt2d, PrevLastPnt2d);
665 Standard_Real len_ne1 = PrevFirstPnt2d.Distance(LastPnt2d);
666 TopoDS_Edge NewEdge1 = BRepLib_MakeEdge(Line1, theSurf,
667 PrevPrevVer, CurVertex,
669 BRepLib::BuildCurve3d(NewEdge1);
670 Standard_Real len_ne2 = FirstPnt2d.Distance(PrevLastPnt2d);
671 TopoDS_Edge NewEdge2 = BRepLib_MakeEdge(Line2, theSurf,
672 PrevVertex, PrevCurVer,
674 BRepLib::BuildCurve3d(NewEdge2);
675 Standard_Boolean good_ne = IsValidEdge(NewEdge, theFace);
676 Standard_Boolean good_ne1 = IsValidEdge(NewEdge1, theFace);
678 GeomAbs_CurveType type_E1 = TypeOfEdge(E1);
679 GeomAbs_CurveType type_E2 = TypeOfEdge(E2);
681 Standard_Integer ChooseEdge = 0;
683 if (!good_ne || type_E1 != type_E2)
685 if (type_E1 == type_E2) //!good_ne
692 else //types are different
694 if (type_E1 == GeomAbs_Line)
696 else if (type_E2 == GeomAbs_Line)
698 else //to be developed later...
705 EdgeSeq(j-1) = NewEdge;
706 EFmap.Add(NewEdge, ListOneFace);
708 else if (ChooseEdge == 1)
710 EdgeSeq(j-1) = NewEdge1;
711 EFmap.Add(NewEdge1, ListOneFace);
712 for (k = 1; k < j-1; k++)
713 EdgeSeq(k).Nullify();
714 for (k = 1; k <= j-1; k++)
716 TopoDS_Edge aLastEdge = TopoDS::Edge(myPaths(k)(i));
717 TopoDS_Shape VertexAsEdge = TopExp::FirstVertex(aLastEdge, Standard_True);
718 myPaths(k).InsertBefore(i, VertexAsEdge);
720 j = 1; //start from beginning
722 else if (ChooseEdge == 2)
724 EdgeSeq(j-1) = NewEdge2;
725 EFmap.Add(NewEdge2, ListOneFace);
726 ToInsertVertex = Standard_True;
728 } //else //E1 is edge
729 } //if (ProperEdge.IsNull())
730 else //connecting edge exists
735 myPaths(j-1).InsertBefore(i, PrevPrevVer);
736 myPaths((j<=NbPaths)? j : 1).InsertBefore(i, PrevCurVer);
741 EdgeSeq(j-1) = ProperEdge;
743 } //for (j = 2; j <= NbVer; j++)
744 SectionsEdges.Append(EdgeSeq);
746 //check for exit from for(;;)
747 Standard_Integer NbEndEdges = 0;
748 for (j = 1; j <= EdgeSeq.Length(); j++)
749 if (EndEdges.Contains(EdgeSeq(j)))
751 if (NbEndEdges == NbE)
758 //final phase: building of middle path
759 Standard_Integer NbSecFaces = SectionsEdges.Length();
760 TopTools_Array1OfShape SecFaces(1, NbSecFaces);
761 for (i = 1; i <= NbSecFaces; i++)
764 for (j = 1; j <= NbE; j++)
766 anEdge = TopoDS::Edge(SectionsEdges(i)(j));
769 if (!myClosedSection)
771 TopExp::Vertices(MW.Wire(), V1, V2);
772 anEdge = BRepLib_MakeEdge(V2, V1);
775 TopoDS_Wire aWire = MW.Wire();
776 BRepLib_MakeFace MF(aWire, Standard_True); //Only plane
778 SecFaces(i) = MF.Face();
783 TColgp_Array1OfPnt Centers(1, NbSecFaces);
784 for (i = 1; i <= NbSecFaces; i++)
786 GProp_GProps Properties;
787 if (SecFaces(i).ShapeType() == TopAbs_FACE)
788 BRepGProp::SurfaceProperties(SecFaces(i), Properties);
790 BRepGProp::LinearProperties(SecFaces(i), Properties);
792 Centers(i) = Properties.CentreOfMass();
795 TopTools_Array1OfShape MidEdges(1, NbSecFaces-1);
796 Standard_Real LinTol = 1.e-5;
797 Standard_Real AngTol = 1.e-7;
799 for (i = 1; i < NbSecFaces; i++)
801 GeomAbs_CurveType TypeOfMidEdge = GeomAbs_OtherCurve;
802 for (j = 1; j <= myPaths.Length(); j++)
804 const TopoDS_Shape& aShape = myPaths(j)(i);
805 if (aShape.ShapeType() == TopAbs_VERTEX)
807 TypeOfMidEdge = GeomAbs_OtherCurve;
810 anEdge = TopoDS::Edge(aShape);
811 GeomAbs_CurveType aType = TypeOfEdge(anEdge);
813 TypeOfMidEdge = aType;
816 if (aType != TypeOfMidEdge)
818 TypeOfMidEdge = GeomAbs_OtherCurve;
823 if (TypeOfMidEdge == GeomAbs_Line)
824 MidEdges(i) = BRepLib_MakeEdge(Centers(i), Centers(i+1));
825 else if (TypeOfMidEdge == GeomAbs_Circle)
828 gp_Dir theDir1, theDir2;
829 Standard_Real theAngle = 0.;
831 Standard_Boolean SimilarArcs = Standard_True;
832 for (j = 1; j <= myPaths.Length(); j++)
834 anEdge = TopoDS::Edge(myPaths(j)(i));
835 Standard_Real fpar, lpar;
836 Handle(Geom_Curve) aCurve = BRep_Tool::Curve(anEdge, fpar, lpar);
837 if (aCurve->IsInstance(STANDARD_TYPE(Geom_TrimmedCurve)))
838 aCurve = ((Handle(Geom_TrimmedCurve)&) aCurve)->BasisCurve();
839 Pnt1 = aCurve->Value(fpar);
840 Pnt2 = aCurve->Value(lpar);
841 Handle(Geom_Circle) aCircle = Handle(Geom_Circle)::DownCast(aCurve);
842 gp_Circ aCirc = aCircle->Circ();
845 theAxis = aCirc.Axis();
846 theDir1 = gp_Vec(aCirc.Location(), Pnt1);
847 theDir2 = gp_Vec(aCirc.Location(), Pnt2);
848 theAngle = lpar - fpar;
849 Standard_Real theParam = (anEdge.Orientation() == TopAbs_FORWARD)?
851 aCurve->D1(theParam, Pnt1, theTangent);
852 if (anEdge.Orientation() == TopAbs_REVERSED)
853 theTangent.Reverse();
857 gp_Ax1 anAxis = aCirc.Axis();
859 if (!aLin.Contains(theAxis.Location(), LinTol) ||
860 !anAxis.IsParallel(theAxis, AngTol))
862 SimilarArcs = Standard_False;
865 gp_Dir aDir1 = gp_Vec(aCirc.Location(), Pnt1);
866 gp_Dir aDir2 = gp_Vec(aCirc.Location(), Pnt2);
867 if (!((aDir1.IsEqual(theDir1, AngTol) && aDir2.IsEqual(theDir2, AngTol)) ||
868 (aDir1.IsEqual(theDir2, AngTol) && aDir2.IsEqual(theDir1, AngTol))))
870 SimilarArcs = Standard_False;
877 gp_XYZ AxisLoc = theAxis.Location().XYZ();
878 gp_XYZ AxisDir = theAxis.Direction().XYZ();
879 Standard_Real Parameter = (Centers(i).XYZ() - AxisLoc) * AxisDir;
880 gp_Pnt theCenterOfCirc(AxisLoc + Parameter*AxisDir);
882 gp_Vec Vec1(theCenterOfCirc, Centers(i));
883 gp_Vec Vec2(theCenterOfCirc, Centers(i+1));
885 gp_Dir VecProd = Vec1 ^ Vec2;
886 if (theAxis.Direction() * VecProd < 0.)
890 Standard_Real anAngle = Vec1.AngleWithRef(Vec2, theAxis.Direction());
893 if (Abs(anAngle - theAngle) > AngTol)
895 gp_Ax2 theAx2(theCenterOfCirc, theAxis.Direction(), Vec1);
896 Handle(Geom_Circle) theCircle = GC_MakeCircle(theAx2, Vec1.Magnitude());
898 theCircle->D1( 0., Pnt1, aTangent );
899 if (aTangent * theTangent < 0.)
902 theAx2 = gp_Ax2(theCenterOfCirc, theAxis.Direction(), Vec1);
903 theCircle = GC_MakeCircle(theAx2, Vec1.Magnitude());
905 BRepLib_MakeEdge aME (theCircle, 0., theAngle);
908 MidEdges(i) = aME.IsDone() ?
916 for (i = 1; i < NbSecFaces; i++)
918 if (MidEdges(i).IsNull())
920 for (j = i+1; j < NbSecFaces; j++)
922 if (!MidEdges(j).IsNull())
925 //from i to j-1 all edges are null
926 Handle(TColgp_HArray1OfPnt) thePoints = new TColgp_HArray1OfPnt(1, j-i+1);
927 TColgp_Array1OfVec theTangents(1, j-i+1);
928 Handle(TColStd_HArray1OfBoolean) theFlags = new TColStd_HArray1OfBoolean(1, j-i+1);
929 for (k = i; k <= j; k++)
930 thePoints->SetValue(k-i+1, Centers(k));
931 for (k = i; k <= j; k++)
933 TColgp_SequenceOfPnt PntSeq;
934 for (Standard_Integer indp = 1; indp <= myPaths.Length(); indp++)
939 if (myPaths(indp)(k).ShapeType() == TopAbs_VERTEX)
941 aTangent = TangentOfEdge(myPaths(indp)(k), Standard_True); //at begin
945 if (myPaths(indp)(k-1).ShapeType() == TopAbs_VERTEX)
947 aTangent = TangentOfEdge(myPaths(indp)(k-1), Standard_False); //at end
951 if (myPaths(indp)(k-1).ShapeType() == TopAbs_VERTEX ||
952 myPaths(indp)(k).ShapeType() == TopAbs_VERTEX)
954 gp_Vec Tangent1 = TangentOfEdge(myPaths(indp)(k-1), Standard_False); //at end
955 gp_Vec Tangent2 = TangentOfEdge(myPaths(indp)(k), Standard_True); //at begin
956 aTangent = Tangent1 + Tangent2;
958 aTangent.Normalize();
959 gp_Pnt aPnt(aTangent.XYZ());
962 TColgp_Array1OfPnt PntArray(1, PntSeq.Length());
963 for (Standard_Integer ip = 1; ip <= PntSeq.Length(); ip++)
964 PntArray(ip) = PntSeq(ip);
967 Standard_Real xgap, ygap, zgap;
968 GeomLib::Inertia(PntArray, theBary, xdir, ydir, xgap, ygap, zgap);
969 gp_Vec theTangent(theBary.XYZ());
970 theTangents(k-i+1) = theTangent;
972 theFlags->Init(Standard_True);
974 GeomAPI_Interpolate Interpol(thePoints, Standard_False, LinTol);
975 Interpol.Load(theTangents, theFlags);
977 if (!Interpol.IsDone())
979 cout<<endl<<"Interpolation failed"<<endl;
981 Handle(Geom_Curve) InterCurve = Interpol.Curve();
982 MidEdges(i) = BRepLib_MakeEdge(InterCurve);
987 BRepLib_MakeWire MakeFinalWire;
988 for (i = 1; i < NbSecFaces; i++)
989 if (!MidEdges(i).IsNull())
990 MakeFinalWire.Add(TopoDS::Edge(MidEdges(i)));
992 TopoDS_Wire FinalWire = MakeFinalWire.Wire();
993 myShape = MakeFinalWire.Wire();
997 TopoDS_Compound aCompound, aCmp1, aCmp2;
999 BB.MakeCompound(aCompound);
1000 BB.MakeCompound(aCmp1);
1001 BB.MakeCompound(aCmp2);
1002 for (i = 1; i <= myPaths.Length(); i++)
1004 TopoDS_Compound aCmp;
1005 BB.MakeCompound(aCmp);
1006 for (j = 1; j <= myPaths(i).Length(); j++)
1007 BB.Add(aCmp, myPaths(i)(j));
1008 BB.Add(aCmp1, aCmp);
1010 for (i = 1; i <= SectionsEdges.Length(); i++)
1014 for (j = 1; j <= SectionsEdges(i).Length(); j++)
1015 BB.Add(aWire, SectionsEdges(i)(j));
1016 BB.Add(aCmp2, aWire);
1018 BB.Add(aCompound, aCmp1);
1019 BB.Add(aCompound, aCmp2);
1020 BB.Add(aCompound, FinalWire);
1022 myShape = aCompound;