-static Standard_Boolean WireToCurve(
- const TopoDS_Wire& theWire,
- NCollection_Vector<TopoDS_Edge>& theEdges,
- Standard_Boolean& theIsClosed)
-{
- TopTools_IndexedDataMapOfShapeListOfShape aVertexToEdges;
- TopExp::MapShapesAndAncestors(theWire,
- TopAbs_VERTEX, TopAbs_EDGE, aVertexToEdges);
- const Standard_Integer aVCount = aVertexToEdges.Extent();
- if (aVCount == 0)
- {
- return Standard_False;
- }
-
- {
- Standard_Integer aEndCount = 0;
- for (Standard_Integer aVN = 1; aVN <= aVCount; ++aVN)
- {
- const Standard_Integer aEdgeCount =
- aVertexToEdges.FindFromIndex(aVN).Extent();
- if (aEdgeCount == 1)
- {
- ++aEndCount;
- }
- if (aEdgeCount > 2)
- {
- return Standard_False;
- }
- }
- theIsClosed = (aEndCount == 0);
- if (!theIsClosed && aEndCount != 2)
- {
- return Standard_False;
- }
- }
-
- Standard_Integer aVN = 1;
- if (!theIsClosed)
- {
- while (aVN <= aVCount &&
- aVertexToEdges.FindFromIndex(aVN).Extent() == 2)
- {
- ++aVN;
- }
- }
-
- TopTools_ListOfShape* aEdges = &aVertexToEdges.ChangeFromIndex(aVN);
- while (!aEdges->IsEmpty())
- {
- const TopoDS_Edge aEdge = TopoDS::Edge(aEdges->First());
- aEdges->RemoveFirst();
- theEdges.Append(aEdge);
- Standard_Integer aVN2 =
- aVertexToEdges.FindIndex(TopExp::FirstVertex(aEdge));
- if (aVN2 == aVN)
- {
- aVN2 = aVertexToEdges.FindIndex(TopExp::LastVertex(aEdge));
- }
- aVN = aVN2;
-
- aEdges = &aVertexToEdges.ChangeFromIndex(aVN2);
- if (aEdges->First().IsEqual(aEdge))
- {
- aEdges->RemoveFirst();
- }
- else
- {
- const TopoDS_Edge aEdge = TopoDS::Edge(aEdges->First());
- aEdges->Clear();
- aEdges->Append(aEdge);
- }
- }
- return (!theIsClosed && theEdges.Size() == aVCount - 1) ||
- (theIsClosed && theEdges.Size() == aVCount);
-}
-
-static void CurveToWire(
- const NCollection_Vector<TopoDS_Edge>& theEdges, TopoDS_Wire& theWire)
-{
- BRep_Builder aBulder;
- aBulder.MakeWire(theWire);
- NCollection_Vector<TopoDS_Edge>::Iterator aEIt(theEdges);
- for (; aEIt.More(); aEIt.Next())
- {
- aBulder.Add(theWire, aEIt.Value());
- }
-}
-
-static void CurveToWire(
- const NCollection_Vector<TopoDS_Edge>& theEdges1,
- const NCollection_Vector<TopoDS_Edge>& theEdges2,
- TopoDS_Wire& theWire)
-{
- BRep_Builder aBulder;
- aBulder.MakeWire(theWire);
- const NCollection_Vector<TopoDS_Edge>* aEdges[] = {&theEdges1, &theEdges2};
- for (Standard_Integer aEI = 0; aEI < 2; ++aEI)
- {
- NCollection_Vector<TopoDS_Edge>::Iterator aEIt(*aEdges[aEI]);
- for (; aEIt.More(); aEIt.Next())
- {
- aBulder.Add(theWire, aEIt.Value());
- }
- }
-}
-
-static Standard_Real ProjectPointToCurve(
- const gp_Pnt& thePoint,
- const Adaptor3d_Curve& theCurve,
- Standard_Real& theParameter)
-{
- Extrema_ExtPC aAlgo(thePoint, theCurve);
- Standard_Integer aMinEN = -2;
- Standard_Real aMinSqDist = DBL_MAX;
- if (aAlgo.IsDone())
- {
- const Standard_Integer aECount = aAlgo.NbExt();
- for (Standard_Integer aEN = 1; aEN <= aECount; ++aEN)
- {
- const gp_Pnt& aP = aAlgo.Point(aEN).Value();
- const Standard_Real aSqDist = thePoint.SquareDistance(aP);
- if (aMinSqDist > aSqDist)
- {
- aMinSqDist = aSqDist;
- aMinEN = aEN;
- }
- }
- }
-
- const Standard_Real aParams[] =
- {theCurve.FirstParameter(), theCurve.LastParameter()};
- const gp_Pnt aEnds[] =
- {theCurve.Value(aParams[0]), theCurve.Value(aParams[1])};
- const Standard_Real aSqDists[] =
- {thePoint.SquareDistance(aEnds[0]), thePoint.SquareDistance(aEnds[1])};
- for (Standard_Integer aEI = 0; aEI < 2; ++aEI)
- {
- if (aMinSqDist > aSqDists[aEI])
- {
- aMinSqDist = aSqDists[aEI];
- aMinEN = -aEI;
- }
- }
-
- if (aMinEN <= 0)
- {
- theParameter = aParams[-aMinEN];
- return aMinSqDist;
- }
-
- const Extrema_POnCurv& aPOnC = aAlgo.Point(aMinEN);
- const gp_Pnt& aPoint = aPOnC.Value();
- theParameter = aPOnC.Parameter();
- for (Standard_Integer aEI = 0; aEI < 2; ++aEI)
- {
- if (Abs(theParameter - aParams[aEI]) < Precision::PConfusion() ||
- aPoint.SquareDistance(aEnds[aEI]) < Precision::SquareConfusion())
- {
- theParameter = aParams[aEI];
- }
- }
- return aMinSqDist;
-}
-
-static Standard_Real ProjectPointToEdge(
- const gp_Pnt& thePoint,
- const TopoDS_Edge& theEdge,
- Standard_Real& theParameter)
-{
- return ProjectPointToCurve(thePoint, BRepAdaptor_Curve(theEdge), theParameter);
-}
-
-static void SplitCurveByPoint(
- const NCollection_Vector<TopoDS_Edge>& theEdges,
- const Standard_Integer theEdgeIndex,
- const Standard_Real theParameter,
- NCollection_Vector<TopoDS_Edge>& theEdges1,
- NCollection_Vector<TopoDS_Edge>& theEdges2)
-{
- for (Standard_Integer aEI = 0; aEI < theEdgeIndex; ++aEI)
- {
- theEdges1.Append(theEdges(aEI));
- }
-
- const TopoDS_Edge& aEdge = theEdges(theEdgeIndex);
- BRepAdaptor_Curve aCurve(aEdge);
- Standard_Integer aParamI = -1;
- const Standard_Real aEdgeEndParams[] =
- {aCurve.FirstParameter(), aCurve.LastParameter()};
- if (Abs(theParameter - aEdgeEndParams[0]) < Precision::PConfusion())
- {
- aParamI = 0;
- }
- else if (Abs(theParameter - aEdgeEndParams[1]) < Precision::PConfusion())
- {
- aParamI = 1;
- }
-
- const TopAbs_Orientation aOrient = aEdge.Orientation();
- if (aOrient == TopAbs_REVERSED)
- {
- aParamI ^= 1;
- }
-
- const Standard_Integer aECount = theEdges.Size();
- if (aParamI == 0)
- {
- NCollection_Vector<TopoDS_Edge>* aEdges = (theEdgeIndex != 0) ? &theEdges1 : &theEdges2;
- for (Standard_Integer aEI = theEdgeIndex; aEI < aECount; ++aEI)
- {
- aEdges->Append(theEdges(aEI));
- }
- }
- else if (aParamI == 1)
- {
- theEdges1.Append(aEdge);
- for (Standard_Integer aEI = theEdgeIndex; aEI < aECount; ++aEI)
- {
- theEdges2.Append(theEdges(aEI));
- }
- }
- else
- {
- TopoDS_Edge aFE = TopoDS::Edge(aEdge.Oriented(TopAbs_FORWARD));
- ShapeAnalysis_TransferParametersProj aSATPP(aFE, TopoDS_Face());
- aSATPP.SetMaxTolerance(Precision::Confusion());
- TopoDS_Vertex aSplitV;
- BRep_Builder().MakeVertex(
- aSplitV, aCurve.Value(theParameter), Precision::Confusion());
-
- TopoDS_Edge aEParts[] = {
- ShapeBuild_Edge().CopyReplaceVertices(aFE, TopoDS_Vertex(),
- TopoDS::Vertex(aSplitV.Oriented(TopAbs_REVERSED))),
- ShapeBuild_Edge().CopyReplaceVertices(aFE, aSplitV, TopoDS_Vertex())};
- ShapeBuild_Edge().CopyPCurves(aEParts[0], aFE);
- ShapeBuild_Edge().CopyPCurves(aEParts[1], aFE);
- BRep_Builder().SameRange(aEParts[0], Standard_False);
- BRep_Builder().SameRange(aEParts[1], Standard_False);
- BRep_Builder().SameParameter(aEParts[0], Standard_False);
- BRep_Builder().SameParameter(aEParts[1], Standard_False);
- aSATPP.TransferRange(aEParts[0],
- aEdgeEndParams[0], theParameter, Standard_False);
- aSATPP.TransferRange(aEParts[1],
- theParameter, aEdgeEndParams[1], Standard_False);
- aEParts[0].Orientation(aOrient);
- aEParts[1].Orientation(aOrient);
-
- const Standard_Integer aFirstPI = (aOrient != TopAbs_REVERSED) ? 0 : 1;
- theEdges1.Append(aEParts[aFirstPI]);
- theEdges2.Append(aEParts[1 - aFirstPI]);
-
- for (Standard_Integer aEI = theEdgeIndex + 1; aEI < aECount; ++aEI)
- {
- theEdges2.Append(theEdges(aEI));
- }
- }
-}
-
-static void SplitCurveByPoints(
- const NCollection_Vector<TopoDS_Edge>& theCurve,
- const NCollection_Vector<NCollection_Sequence<Standard_Real> >& theParameters,
- NCollection_Vector<NCollection_Vector<TopoDS_Edge> >& theSplittedCurves)
-{
- NCollection_Vector<TopoDS_Edge> aCurves[3];
- aCurves[0] = theCurve;
- Standard_Integer aCI = 0, aEI = 0;
- NCollection_Vector<TopoDS_Edge>::Iterator aEIt(theCurve);
- for (NCollection_Vector<NCollection_Sequence<Standard_Real> >::Iterator
- aPLIt(theParameters); aPLIt.More(); ++aEI, aEIt.Next(), aPLIt.Next())
- {
- const Standard_Boolean isForward =
- (aEIt.Value().Orientation() != TopAbs_REVERSED);
- for (NCollection_Sequence<Standard_Real>::Iterator
- aPIt(aPLIt.Value(), isForward); aPIt.More(); aPIt.Next())
- {
- const Standard_Integer aCI1 = (aCI + 1) % 3, aCI2 = (aCI + 2) % 3;
- SplitCurveByPoint(aCurves[aCI], aEI,
- aPIt.Value(), aCurves[aCI1], aCurves[aCI2]);
- if (!aCurves[aCI2].IsEmpty())
- {
- theSplittedCurves.Append(aCurves[aCI1]);
- aCurves[aCI].Clear();
- aCI = aCI2;
- aEI = 0;
- }
- aCurves[aCI1].Clear();
- }
- }
- theSplittedCurves.Append(aCurves[aCI]);
-}
-
-static Standard_Integer AppendIntersectionPoint(
- const Adaptor3d_Curve& theCurve,
- const Standard_Real theParameter,
- NCollection_Sequence<Standard_Real>& theParameters)
-{
- // Check the coincidence.
- NCollection_Sequence<Standard_Real> aEndParams;
- aEndParams.Append(theCurve.FirstParameter());
- aEndParams.Append(theCurve.LastParameter());
- NCollection_Sequence<Standard_Real>* aParams[] =
- {&theParameters, &aEndParams};
- const gp_Pnt aPoint = theCurve.Value(theParameter);
- for (Standard_Integer aLI = 0; aLI < 2; ++aLI)
- {
- NCollection_Sequence<Standard_Real>::Iterator aPIt(*aParams[aLI]);
- for (Standard_Integer aPI = 0; aPIt.More(); aPIt.Next(), ++aPI)
- {
- const Standard_Real aParam = aPIt.Value();
- if (Abs(theParameter - aParam) < Precision::PConfusion() ||
- aPoint.SquareDistance(theCurve.Value(aParam)) <=
- Precision::SquareConfusion())
- {
- Standard_Integer aIntCount = 0;
- if (aLI != 0)
- {
- if (aPI == 0)
- {
- theParameters.Prepend(aEndParams.First());
- }
- else
- {
- theParameters.Append(aEndParams.Last());
- }
- ++aIntCount;
- }
- return aIntCount;
- }
- }
- }
-
- // Calculate the position to insert.
- NCollection_Sequence<Standard_Real>::Iterator aPIt(theParameters);
- if (aPIt.More() && aPIt.Value() < theParameter)
- {
- NCollection_Sequence<Standard_Real>::Iterator aPIt2 = aPIt;
- aPIt2.Next();
- for (; aPIt2.More() && aPIt2.Value() < theParameter;
- aPIt.Next(), aPIt2.Next());
- theParameters.InsertAfter(aPIt, theParameter);
- }
- else
- {
- theParameters.Prepend(theParameter);
- }
- return 1;
-}
-
-static Standard_Integer IntersectEdge(
- const TopoDS_Edge& theEdge1,
- const TopoDS_Edge& theEdge2,
- NCollection_Sequence<Standard_Real>& theParameters)
-{
- // Process the ends.
- Standard_Integer aIntCount = 0;
- BRepAdaptor_Curve aCurve1 = BRepAdaptor_Curve(theEdge1);
- BRepAdaptor_Curve aCurve2 = BRepAdaptor_Curve(theEdge2);
- const gp_Pnt aEndPs[] = {aCurve2.Value(aCurve2.FirstParameter()),
- aCurve2.Value(aCurve2.LastParameter())};
- for (Standard_Integer aPI = 0; aPI < 2; ++aPI)
- {
- Standard_Real aParameter;
- if (ProjectPointToCurve(aEndPs[aPI], aCurve1, aParameter) <=
- Precision::SquareConfusion())
- {
- AppendIntersectionPoint(aCurve1, aParameter, theParameters);
- }
- }
-
- // Process the internal extrema.
- Extrema_ExtCC aAlgo(aCurve1, aCurve2);
- if (aAlgo.IsDone())
- {
- const Standard_Integer aECount = aAlgo.NbExt();
- for (Standard_Integer aEN = 1; aEN <= aECount; ++aEN)
- {
- Extrema_POnCurv aP1, aP2;
- aAlgo.Points(aEN, aP1, aP2);
- if (aP1.Value().SquareDistance(aP2.Value()) <=
- Precision::SquareConfusion())
- {
- AppendIntersectionPoint(aCurve1, aP1.Parameter(), theParameters);
- }
- }
- }
- return aIntCount;
-}
-
-static Standard_Integer IntersectCurve(
- const NCollection_Vector<TopoDS_Edge>& theEdges,
- const TopoDS_Wire& theWire,
- NCollection_Vector<NCollection_Sequence<Standard_Real> >& theParameters)
-{
- Standard_Integer aIntCount = 0;
- const Standard_Integer aECount1 = theEdges.Size();
- for (Standard_Integer aEI1 = 0; aEI1 < aECount1; ++aEI1)
- {
- const TopoDS_Edge& aEdge1 = theEdges(aEI1);
- TopExp_Explorer aEIt2(theWire, TopAbs_EDGE);
- for (; aEIt2.More(); aEIt2.Next())
- {
- aIntCount += IntersectEdge(aEdge1,
- TopoDS::Edge(aEIt2.Current()), theParameters(aEI1));
- }
- }
- return aIntCount;
-}
-