Loading files
f2929057eThis file is pinned to the selected release. Download the original to open it in your design tool.
// Created on: 2012-06-09
// Created by: jgv@ROLEX
// Copyright (c) 2012-2014 OPEN CASCADE SAS
//
// This file is part of Open CASCADE Technology software library.
//
// This library is free software; you can redistribute it and/or modify it under
// the terms of the GNU Lesser General Public License version 2.1 as published
// by the Free Software Foundation, with special exception defined in the file
// OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
// distribution for complete text of the license and disclaimer of any warranty.
//
// Alternatively, this file may be used under the terms of Open CASCADE
// commercial license or contractual agreement.
#include <ShapeUpgrade_UnifySameDomain.hxx>
#include <BRep_Builder.hxx>
#include <BRep_Tool.hxx>
#include <BRepLib.hxx>
#include <BRepTopAdaptor_TopolTool.hxx>
#include <GC_MakeCircle.hxx>
#include <Geom2d_Circle.hxx>
#include <GC_MakeLine2d.hxx>
#include <Geom2d_TrimmedCurve.hxx>
#include <Geom2dConvert.hxx>
#include <Geom2dConvert_CompCurveToBSplineCurve.hxx>
#include <Geom_BezierCurve.hxx>
#include <Geom_BSplineCurve.hxx>
#include <Geom_BSplineSurface.hxx>
#include <Geom_Circle.hxx>
#include <Geom_Ellipse.hxx>
#include <Geom_CylindricalSurface.hxx>
#include <Geom_ElementarySurface.hxx>
#include <Geom_Line.hxx>
#include <Geom_Plane.hxx>
#include <Geom_RectangularTrimmedSurface.hxx>
#include <Geom_Surface.hxx>
#include <Geom_SurfaceOfLinearExtrusion.hxx>
#include <Geom_SurfaceOfRevolution.hxx>
#include <Geom_SweptSurface.hxx>
#include <Geom_TrimmedCurve.hxx>
#include <GeomConvert.hxx>
#include <GeomConvert_ApproxSurface.hxx>
#include <GeomConvert_CompCurveToBSplineCurve.hxx>
#include <GeomLib_IsPlanarSurface.hxx>
#include <gp_Cylinder.hxx>
#include <gp_Dir.hxx>
#include <gp_Lin.hxx>
#include <IntPatch_ImpImpIntersection.hxx>
#include <ShapeAnalysis_Edge.hxx>
#include <ShapeAnalysis_WireOrder.hxx>
#include <ShapeAnalysis_Surface.hxx>
#include <ShapeBuild_ReShape.hxx>
#include <ShapeConstruct_ProjectCurveOnSurface.hxx>
#include <ShapeFix_Face.hxx>
#include <ShapeFix_Shell.hxx>
#include <ShapeFix_Wire.hxx>
#include <Standard_NullValue.hxx>
#include <Standard_Type.hxx>
#include <Geom2d_BSplineCurve.hxx>
#include <NCollection_Array1.hxx>
#include <NCollection_HArray1.hxx>
#include <Geom2d_BoundedCurve.hxx>
#include <NCollection_Sequence.hxx>
#include <Geom2d_Curve.hxx>
#include <Standard_Integer.hxx>
#include <NCollection_Map.hxx>
#include <TopExp.hxx>
#include <TopExp_Explorer.hxx>
#include <TopoDS.hxx>
#include <TopoDS_Edge.hxx>
#include <TopoDS_Face.hxx>
#include <TopoDS_Shape.hxx>
#include <NCollection_List.hxx>
#include <TopTools_ShapeMapHasher.hxx>
#include <NCollection_IndexedDataMap.hxx>
#include <NCollection_IndexedMap.hxx>
#include <gp_Circ.hxx>
#include <BRepAdaptor_Curve.hxx>
#include <BRepAdaptor_Curve2d.hxx>
#include <BRepAdaptor_Surface.hxx>
#include <gp_Vec2d.hxx>
#include <BRepTools.hxx>
#include <BRepTopAdaptor_FClass2d.hxx>
#include <ElCLib.hxx>
#include <BRepBuilderAPI_MakeEdge.hxx>
#include <ElSLib.hxx>
#include <GeomProjLib.hxx>
IMPLEMENT_STANDARD_RTTIEXT(ShapeUpgrade_UnifySameDomain, Standard_Transient)
static bool IsOnSingularity(const NCollection_List<TopoDS_Shape>& theEdgeList)
{
NCollection_List<TopoDS_Shape>::Iterator anItl(theEdgeList);
for (; anItl.More(); anItl.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(anItl.Value());
if (BRep_Tool::Degenerated(anEdge))
{
return true;
}
}
return false;
}
//=======================================================================
// function : IsUiso
// purpose : only for seam edges assumed to be U- or V- isolines
//=======================================================================
static bool IsUiso(const TopoDS_Edge& theEdge, const TopoDS_Face& theFace)
{
BRepAdaptor_Curve2d aBAcurve2d(theEdge, theFace);
gp_Pnt2d aP2d;
gp_Vec2d aVec;
aBAcurve2d.D1(aBAcurve2d.FirstParameter(), aP2d, aVec);
return (std::abs(aVec.Y()) > std::abs(aVec.X()));
}
static bool IsLinear(const BRepAdaptor_Curve& theBAcurve, gp_Dir& theDir)
{
GeomAbs_CurveType aType = theBAcurve.GetType();
if (aType == GeomAbs_Line)
{
theDir = theBAcurve.Line().Position().Direction();
return true;
}
if ((aType == GeomAbs_BezierCurve || aType == GeomAbs_BSplineCurve) && theBAcurve.NbPoles() == 2)
{
gp_Pnt aFirstPnt = theBAcurve.Value(theBAcurve.FirstParameter());
gp_Pnt aLastPnt = theBAcurve.Value(theBAcurve.LastParameter());
theDir = gp_Vec(aFirstPnt, aLastPnt);
return true;
}
return false;
}
static void SplitWire(const TopoDS_Wire& theWire,
const TopoDS_Face& theFace,
const NCollection_IndexedMap<TopoDS_Shape, TopTools_ShapeMapHasher>& theVmap,
NCollection_Sequence<TopoDS_Shape>& theWireSeq);
static double TrueValueOfOffset(const double theValue, const double thePeriod)
{
if (theValue > 0.)
{
return thePeriod;
}
return (-thePeriod);
}
//=======================================================================
// function : GetFaceFromSeq
// purpose : gets a face from the sequence that has a common boundary
// with already got <theUsedFaces>. If it is possible,
// gets a face that has a common boundary in 2D space too
// (excludes seam edges).
// <theIndFace> returns the Index of the face in the sequence.
//=======================================================================
static TopoDS_Face GetFaceFromSeq(
const NCollection_Sequence<TopoDS_Shape>& theFaces,
const TopoDS_Face& theRefFace,
const NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>& theMapEF,
NCollection_IndexedMap<TopoDS_Shape, TopTools_ShapeMapHasher>& theUsedFaces,
int& theIndFace)
{
if (theUsedFaces.IsEmpty())
{
theIndFace = 1;
theUsedFaces.Add(theFaces(1));
return TopoDS::Face(theFaces(1));
}
TopoDS_Edge aSeamEdge;
TopoDS_Face aTargetFace;
for (int ii = 1; ii <= theUsedFaces.Extent(); ii++)
{
const TopoDS_Face& aUsedFace = TopoDS::Face(theUsedFaces(ii));
TopExp_Explorer anExplo(aUsedFace, TopAbs_EDGE);
for (; anExplo.More(); anExplo.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(anExplo.Current());
const NCollection_List<TopoDS_Shape>& aFaceList = theMapEF.FindFromKey(anEdge);
if (aFaceList.Extent() < 2)
{
continue;
}
const TopoDS_Face& aFace = (aFaceList.First().IsSame(aUsedFace))
? TopoDS::Face(aFaceList.Last())
: TopoDS::Face(aFaceList.First());
if (theUsedFaces.Contains(aFace))
{
continue;
}
if (BRep_Tool::IsClosed(anEdge, theRefFace))
{
aSeamEdge = anEdge;
continue;
}
aTargetFace = aFace;
break;
}
if (aTargetFace.IsNull() && !aSeamEdge.IsNull())
{
const NCollection_List<TopoDS_Shape>& aFaceList = theMapEF.FindFromKey(aSeamEdge);
aTargetFace = (aFaceList.First().IsSame(aUsedFace)) ? TopoDS::Face(aFaceList.Last())
: TopoDS::Face(aFaceList.First());
}
if (!aTargetFace.IsNull())
{
break;
}
}
theUsedFaces.Add(aTargetFace);
for (int ii = 2; ii <= theFaces.Length(); ii++)
{
if (theFaces(ii).IsSame(aTargetFace))
{
theIndFace = ii;
break;
}
}
return aTargetFace;
}
//=================================================================================================
static void UpdateBoundaries(const occ::handle<Geom2d_Curve>& thePCurve,
const double theFirst,
const double theLast,
const int theIndCoord,
double& theMinCoord,
double& theMaxCoord)
{
const int NbSamples = 4;
double Delta = (theLast - theFirst) / NbSamples;
for (int i = 0; i <= NbSamples; i++)
{
double aParam = theFirst + i * Delta;
gp_Pnt2d aPoint = thePCurve->Value(aParam);
if (aPoint.Coord(theIndCoord) < theMinCoord)
{
theMinCoord = aPoint.Coord(theIndCoord);
}
if (aPoint.Coord(theIndCoord) > theMaxCoord)
{
theMaxCoord = aPoint.Coord(theIndCoord);
}
}
}
static bool TryMakeLine(const occ::handle<Geom2d_Curve>& thePCurve,
const double theFirst,
const double theLast,
occ::handle<Geom2d_Line>& theLine)
{
gp_Pnt2d aFirstPnt = thePCurve->Value(theFirst);
gp_Pnt2d aLastPnt = thePCurve->Value(theLast);
gp_Vec2d aVec(aFirstPnt, aLastPnt);
double aSqLen = aVec.SquareMagnitude();
double aSqParamLen = (theLast - theFirst) * (theLast - theFirst);
if (std::abs(aSqLen - aSqParamLen) > Precision::Confusion())
{
return false;
}
gp_Dir2d aDir = aVec;
gp_Vec2d anOffset = -aDir;
anOffset *= theFirst;
gp_Pnt2d anOrigin = aFirstPnt.Translated(anOffset);
gp_Lin2d aLin(anOrigin, aDir);
const int NbSamples = 10;
double aDelta = (theLast - theFirst) / NbSamples;
for (int i = 1; i < NbSamples; i++)
{
double aParam = theFirst + i * aDelta;
gp_Pnt2d aPnt = thePCurve->Value(aParam);
double aDist = aLin.Distance(aPnt);
if (aDist > Precision::Confusion())
{
return false;
}
}
theLine = new Geom2d_Line(aLin);
return true;
}
// Removes the specified edge from the vertex to edge map.
// @param theEdge The edge to remove.
// @param theVertexToEdges The map of vertices to edges.
// @return True if the edge was removed, false otherwise.
static bool RemoveEdgeFromMap(
const TopoDS_Edge& theEdge,
NCollection_IndexedDataMap<TopoDS_Shape, NCollection_List<TopoDS_Shape>, TopTools_ShapeMapHasher>&
theVertexToEdges)
{
bool anIsRemoved = false;
TopoDS_Vertex aFirstVertex;
TopoDS_Vertex aLastVertex;
TopExp::Vertices(theEdge, aFirstVertex, aLastVertex);
for (const auto& aVertex : {aFirstVertex, aLastVertex})
{
if (!theVertexToEdges.Contains(aVertex))
{
continue;
}
NCollection_List<TopoDS_Shape>& aVertexEdges = theVertexToEdges.ChangeFromKey(aVertex);
NCollection_List<TopoDS_Shape>::Iterator anEdgesIter(aVertexEdges);
while (anEdgesIter.More())
{
const TopoDS_Shape& anEdge = anEdgesIter.Value();
if (anEdge.IsSame(theEdge))
{
anIsRemoved = true;
aVertexEdges.Remove(anEdgesIter);
}
else
{
anEdgesIter.Next();
}
}
}
return anIsRemoved;
}
static double ComputeMinEdgeSize(
const NCollection_Sequence<TopoDS_Shape>& theEdges,
const TopoDS_Face& theRefFace,
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& theEdgesMap)
{
double MinSize = RealLast();
for (int ind = 1; ind <= theEdges.Length(); ind++)
{
const TopoDS_Edge& anEdge = TopoDS::Edge(theEdges(ind));
theEdgesMap.Add(anEdge);
TopoDS_Vertex V1, V2;
TopExp::Vertices(anEdge, V1, V2);
BRepAdaptor_Curve2d BAcurve2d(anEdge, theRefFace);
if (BAcurve2d.Curve().IsNull())
{
continue;
}
const gp_Pnt2d FirstP2d = BAcurve2d.Value(BAcurve2d.FirstParameter());
const gp_Pnt2d LastP2d = BAcurve2d.Value(BAcurve2d.LastParameter());
double aSqDist;
if (V1.IsSame(V2) && !BRep_Tool::Degenerated(anEdge))
{
gp_Pnt2d MidP2d =
BAcurve2d.Value((BAcurve2d.FirstParameter() + BAcurve2d.LastParameter()) / 2);
aSqDist = FirstP2d.SquareDistance(MidP2d);
}
else
{
aSqDist = FirstP2d.SquareDistance(LastP2d);
}
MinSize = std::min(MinSize, aSqDist);
}
MinSize = std::sqrt(MinSize);
return MinSize;
}
//=======================================================================
// function : FindCoordBounds
// purpose : Searching for origin of U in 2d space
// Returns false if could not find curve on surface
// Returns true if succeed
//=======================================================================
static bool FindCoordBounds(
const NCollection_Sequence<TopoDS_Shape>& theFaces,
const TopoDS_Face& theRefFace,
const NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>& theMapEF,
const NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& theEdgesMap,
const int theIndCoord,
const double thePeriod,
double& theMinCoord,
double& theMaxCoord,
int& theNumberOfIntervals,
int& theIndFaceMax)
{
NCollection_Sequence<std::pair<double, double>> aPairSeq;
double aSimpleMax = RealFirst();
theIndFaceMax = 0;
NCollection_IndexedMap<TopoDS_Shape, TopTools_ShapeMapHasher> aUsedFaces;
TopoDS_Face aLastFace;
for (int ii = 1; ii <= theFaces.Length(); ii++)
{
int anIndFace = 0;
// Get a face bordering with previous ones
TopoDS_Face aFace = GetFaceFromSeq(theFaces, theRefFace, theMapEF, aUsedFaces, anIndFace);
double aMinCoord = RealLast(), aMaxCoord = RealFirst();
TopExp_Explorer Explo(aFace, TopAbs_EDGE);
for (; Explo.More(); Explo.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(Explo.Current());
if (!theEdgesMap.Contains(anEdge))
{
continue;
}
double fpar, lpar;
occ::handle<Geom2d_Curve> aPCurve = BRep_Tool::CurveOnSurface(anEdge, theRefFace, fpar, lpar);
if (aPCurve.IsNull())
{
return false;
}
UpdateBoundaries(aPCurve, fpar, lpar, theIndCoord, aMinCoord, aMaxCoord);
}
if (Precision::IsInfinite(aMinCoord) || Precision::IsInfinite(aMaxCoord))
{
continue;
}
if (aMaxCoord > aSimpleMax)
{
aSimpleMax = aMaxCoord;
theIndFaceMax = anIndFace;
}
// Insert new interval (aMinCoord, aMaxCoord) into sequence of intervals
bool anIsInInterval = false;
for (int jj = 1; jj <= aPairSeq.Length(); jj++)
{
double aLocalMin = aPairSeq(jj).first;
double aLocalMax = aPairSeq(jj).second;
if (aMinCoord >= aLocalMin && aMinCoord <= aLocalMax && aMaxCoord >= aLocalMin
&& aMaxCoord <= aLocalMax)
{
anIsInInterval = true;
break;
}
if (aMinCoord < aLocalMin && (aMaxCoord >= aLocalMin && aMaxCoord <= aLocalMax))
{
aPairSeq(jj).first = aMinCoord;
anIsInInterval = true;
break;
}
else if (aMinCoord < aLocalMin && aMaxCoord > aLocalMax)
{
aPairSeq(jj).first = aMinCoord;
aPairSeq(jj).second = aMaxCoord;
anIsInInterval = true;
break;
}
else if ((aMinCoord >= aLocalMin && aMinCoord <= aLocalMax) && aMaxCoord > aLocalMax)
{
aPairSeq(jj).second = aMaxCoord;
anIsInInterval = true;
break;
}
}
if (!anIsInInterval)
{
std::pair<double, double> anInterval(aMinCoord, aMaxCoord);
if (!aPairSeq.IsEmpty() && aMaxCoord < aPairSeq(1).first)
{
aPairSeq.Prepend(anInterval);
}
else
{
aPairSeq.Append(anInterval);
}
}
}
theNumberOfIntervals = aPairSeq.Length();
if (aPairSeq.Length() == 2)
{
theMinCoord = aPairSeq(2).first - thePeriod;
}
else if (aPairSeq.Length() > 0)
{
theMinCoord = aPairSeq(1).first;
}
else
{
return false;
}
theMaxCoord = aPairSeq(1).second;
return true;
}
//=================================================================================================
// Returns the start and end points of the edge in parametric space of the face.
// The orientation of the edge is taken into account, so the start and end points
// will be swapped if the edge has a reversed orientation.
// @param theEdge The edge to get the points from.
// @param theRefFace The reference face to get the parametric points.
// @return A pair of points representing the start and end points of the edge in parametric space.
static std::pair<gp_Pnt2d, gp_Pnt2d> getCurveParams(const TopoDS_Edge& theEdge,
const TopoDS_Face& theRefFace)
{
BRepAdaptor_Curve2d aCurveAdaptor(theEdge, theRefFace);
double aFirstParam = aCurveAdaptor.FirstParameter();
double aLastParam = aCurveAdaptor.LastParameter();
if (theEdge.Orientation() != TopAbs_FORWARD)
{
std::swap(aFirstParam, aLastParam);
}
const gp_Pnt2d aFirstPoint = aCurveAdaptor.Value(aFirstParam);
const gp_Pnt2d aLastPoint = aCurveAdaptor.Value(aLastParam);
return {aFirstPoint, aLastPoint};
}
//=================================================================================================
static bool RelocatePCurvesToNewUorigin(
const NCollection_Sequence<TopoDS_Shape>& theEdges,
const TopoDS_Shape& theFirstFace,
const TopoDS_Face& theRefFace,
const double theCoordTol,
const int theIndCoord,
const double thePeriod,
NCollection_IndexedDataMap<TopoDS_Shape, NCollection_List<TopoDS_Shape>, TopTools_ShapeMapHasher>&
theVEmap,
NCollection_DataMap<TopoDS_Shape, occ::handle<Geom2d_Curve>>& theEdgeNewPCurve,
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& theUsedEdges)
{
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> anEdgesOfFirstFace;
TopExp::MapShapes(theFirstFace, anEdgesOfFirstFace);
for (;;) // walk by contours
{
// try to find the start edge that:
// 1. belongs to outer edges of first face;
// 2. has minimum U-coord of its start point
TopoDS_Edge aStartEdge;
TopAbs_Orientation anOrientation = TopAbs_FORWARD;
double aCoordMin = RealLast();
for (int anEdgeIndex = 1; anEdgeIndex <= theEdges.Length(); ++anEdgeIndex)
{
const TopoDS_Edge& anEdge = TopoDS::Edge(theEdges(anEdgeIndex));
if (theUsedEdges.Contains(anEdge))
{
continue;
}
if (!anEdgesOfFirstFace.Contains(anEdge))
{
continue;
}
if (aStartEdge.IsNull())
{
aStartEdge = anEdge;
const auto&& [aFirstPoint, aLastPoint] = getCurveParams(anEdge, theRefFace);
if (aFirstPoint.Coord(theIndCoord) < aLastPoint.Coord(theIndCoord))
{
aCoordMin = aFirstPoint.Coord(theIndCoord);
anOrientation = TopAbs_FORWARD;
}
else
{
aCoordMin = aLastPoint.Coord(theIndCoord);
anOrientation = TopAbs_REVERSED;
}
}
else
{
const auto&& [aFirstPoint, aLastPoint] = getCurveParams(anEdge, theRefFace);
if (aFirstPoint.Coord(theIndCoord) < aCoordMin)
{
aStartEdge = anEdge;
aCoordMin = aFirstPoint.Coord(theIndCoord);
anOrientation = TopAbs_FORWARD;
}
if (aLastPoint.Coord(theIndCoord) < aCoordMin)
{
aStartEdge = anEdge;
aCoordMin = aLastPoint.Coord(theIndCoord);
anOrientation = TopAbs_REVERSED;
}
}
}
if (aStartEdge.IsNull()) // all contours are passed
{
break;
}
TopoDS_Edge aCurrentEdge = aStartEdge;
double anEdgeStartParam, anEdgeEndParam;
occ::handle<Geom2d_Curve> CurPCurve =
BRep_Tool::CurveOnSurface(aCurrentEdge, theRefFace, anEdgeStartParam, anEdgeEndParam);
if (CurPCurve.IsNull())
{
return false;
}
CurPCurve = new Geom2d_TrimmedCurve(CurPCurve, anEdgeStartParam, anEdgeEndParam);
theEdgeNewPCurve.Bind(aCurrentEdge, CurPCurve);
if (aCurrentEdge.Orientation() == TopAbs_REVERSED)
{
std::swap(anEdgeStartParam, anEdgeEndParam);
}
double CurParam = (anOrientation == TopAbs_FORWARD) ? anEdgeEndParam : anEdgeStartParam;
gp_Pnt2d CurPoint = CurPCurve->Value(CurParam);
for (;;) // collect pcurves of a contour
{
if (!RemoveEdgeFromMap(aCurrentEdge, theVEmap))
{
break; // end of contour in 2d
}
theUsedEdges.Add(aCurrentEdge);
TopoDS_Vertex CurVertex = (anOrientation == TopAbs_FORWARD)
? TopExp::LastVertex(aCurrentEdge, true)
: TopExp::FirstVertex(aCurrentEdge, true);
const NCollection_List<TopoDS_Shape>& Elist = theVEmap.FindFromKey(CurVertex);
if (Elist.IsEmpty())
{
break; // end of contour in 3d
}
for (NCollection_List<TopoDS_Shape>::Iterator itl(Elist); itl.More(); itl.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(itl.Value());
if (anEdge.IsSame(aCurrentEdge))
{
continue;
}
TopoDS_Vertex aFirstVertex = (anOrientation == TopAbs_FORWARD)
? TopExp::FirstVertex(anEdge, true)
: TopExp::LastVertex(anEdge, true);
if (!aFirstVertex.IsSame(CurVertex)) // may be if CurVertex is deg.vertex
{
continue;
}
occ::handle<Geom2d_Curve> aPCurve =
BRep_Tool::CurveOnSurface(anEdge, theRefFace, anEdgeStartParam, anEdgeEndParam);
if (aPCurve.IsNull())
{
return false;
}
aPCurve = new Geom2d_TrimmedCurve(aPCurve, anEdgeStartParam, anEdgeEndParam);
if (anEdge.Orientation() == TopAbs_REVERSED)
{
std::swap(anEdgeStartParam, anEdgeEndParam);
}
double aParam = (anOrientation == TopAbs_FORWARD) ? anEdgeStartParam : anEdgeEndParam;
gp_Pnt2d aPoint = aPCurve->Value(aParam);
double anOffset = CurPoint.Coord(theIndCoord) - aPoint.Coord(theIndCoord);
if (std::abs(anOffset) >= theCoordTol
&& std::abs(std::abs(anOffset) - thePeriod) >= theCoordTol)
{
continue; // may be if CurVertex is deg.vertex
}
if (std::abs(anOffset) > thePeriod / 2)
{
anOffset = TrueValueOfOffset(anOffset, thePeriod);
gp_Vec2d aVec;
if (theIndCoord == 1)
{
aVec.SetCoord(anOffset, 0.);
}
else
{
aVec.SetCoord(0., anOffset);
}
occ::handle<Geom2d_Curve> aNewPCurve = occ::down_cast<Geom2d_Curve>(aPCurve->Copy());
aNewPCurve->Translate(aVec);
aPCurve = aNewPCurve;
}
theEdgeNewPCurve.Bind(anEdge, aPCurve);
aCurrentEdge = anEdge;
TopAbs_Orientation CurOr = TopAbs::Compose(anOrientation, aCurrentEdge.Orientation());
CurParam = (CurOr == TopAbs_FORWARD) ? aPCurve->LastParameter() : aPCurve->FirstParameter();
CurPoint = aPCurve->Value(CurParam);
break;
}
} // for (;;) (collect pcurves of a contour)
} // for (;;) (walk by contours)
return true;
}
static void InsertWiresIntoFaces(const NCollection_Sequence<TopoDS_Shape>& theWires,
const NCollection_Sequence<TopoDS_Shape>& theFaces,
const TopoDS_Face& theRefFace)
{
BRep_Builder BB;
for (int ii = 1; ii <= theWires.Length(); ii++)
{
const TopoDS_Wire& aWire = TopoDS::Wire(theWires(ii));
TopoDS_Iterator iter(aWire);
const TopoDS_Edge& anEdge = TopoDS::Edge(iter.Value());
BRepAdaptor_Curve2d BAcurve2d(anEdge, theRefFace);
gp_Pnt2d aPnt2d =
BAcurve2d.Value((BAcurve2d.FirstParameter() + BAcurve2d.LastParameter()) / 2.);
TopoDS_Shape RequiredFace;
for (int jj = 1; jj <= theFaces.Length(); jj++)
{
const TopoDS_Face& aFace = TopoDS::Face(theFaces(jj));
BRepTopAdaptor_FClass2d Classifier(aFace, Precision::Confusion());
TopAbs_State aStatus = Classifier.Perform(aPnt2d);
if (aStatus == TopAbs_IN)
{
RequiredFace = aFace.Oriented(TopAbs_FORWARD);
break;
}
}
if (!RequiredFace.IsNull())
{
BB.Add(RequiredFace, aWire);
}
else
{
Standard_ASSERT_INVOKE("ShapeUpgrade_UnifySameDomain: wire remains unclassified");
}
}
}
static TopoDS_Face FindCommonFace(
const TopoDS_Edge& theEdge1,
const TopoDS_Edge& theEdge2,
const NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>& theVFmap,
TopAbs_Orientation& theOrOfE1OnFace,
TopAbs_Orientation& theOrOfE2OnFace)
{
TopoDS_Vertex aVertex;
TopExp::CommonVertex(theEdge1, theEdge2, aVertex);
const NCollection_List<TopoDS_Shape>& Flist = theVFmap.FindFromKey(aVertex);
NCollection_List<TopoDS_Shape>::Iterator itl(Flist);
for (; itl.More(); itl.Next())
{
TopoDS_Face aFace = TopoDS::Face(itl.Value());
aFace.Orientation(TopAbs_FORWARD);
bool e1found = false, e2found = false;
TopExp_Explorer Explo(aFace, TopAbs_EDGE);
for (; Explo.More(); Explo.Next())
{
const TopoDS_Shape& anEdge = Explo.Current();
if (anEdge.IsSame(theEdge1))
{
e1found = true;
theOrOfE1OnFace = anEdge.Orientation();
}
if (anEdge.IsSame(theEdge2))
{
e2found = true;
theOrOfE2OnFace = anEdge.Orientation();
}
if (e1found && e2found)
{
return aFace;
}
}
}
TopoDS_Face NullFace;
return NullFace;
}
static bool FindClosestPoints(const TopoDS_Edge& theEdge1,
const TopoDS_Edge& theEdge2,
const NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>& theVFmap,
TopoDS_Face& theCommonFace,
double& theMinSqDist,
TopAbs_Orientation& OrOfE1OnFace,
TopAbs_Orientation& OrOfE2OnFace,
int& theIndOnE1,
int& theIndOnE2,
gp_Pnt2d* PointsOnEdge1,
gp_Pnt2d* PointsOnEdge2)
{
theCommonFace = FindCommonFace(theEdge1, theEdge2, theVFmap, OrOfE1OnFace, OrOfE2OnFace);
if (theCommonFace.IsNull())
{
return false;
}
double fpar1, lpar1, fpar2, lpar2;
occ::handle<Geom2d_Curve> PCurve1 =
BRep_Tool::CurveOnSurface(theEdge1, theCommonFace, fpar1, lpar1);
occ::handle<Geom2d_Curve> PCurve2 =
BRep_Tool::CurveOnSurface(theEdge2, theCommonFace, fpar2, lpar2);
if (PCurve1.IsNull() || PCurve2.IsNull())
{
return false;
}
PointsOnEdge1[0] = PCurve1->Value(fpar1);
PointsOnEdge1[1] = PCurve1->Value(lpar1);
PointsOnEdge2[0] = PCurve2->Value(fpar2);
PointsOnEdge2[1] = PCurve2->Value(lpar2);
theMinSqDist = RealLast();
theIndOnE1 = -1;
theIndOnE2 = -1;
for (int ind1 = 0; ind1 < 2; ind1++)
{
for (int ind2 = 0; ind2 < 2; ind2++)
{
double aSqDist = PointsOnEdge1[ind1].SquareDistance(PointsOnEdge2[ind2]);
if (aSqDist < theMinSqDist)
{
theMinSqDist = aSqDist;
theIndOnE1 = ind1;
theIndOnE2 = ind2;
}
}
}
return true;
}
//=================================================================================================
static void ReconstructMissedSeam(const NCollection_Sequence<TopoDS_Shape>& theRemovedEdges,
const TopoDS_Face& theFrefFace,
const TopoDS_Edge& theCurEdge,
const TopoDS_Vertex& theCurVertex,
const gp_Pnt2d& theCurPoint,
const double theUperiod,
const double theVperiod,
TopoDS_Edge& theSeamEdge,
gp_Pnt2d& theNextPoint)
{
occ::handle<Geom_Surface> RefSurf = BRep_Tool::Surface(theFrefFace);
// Find seam edge between removed edges
theSeamEdge.Nullify();
for (int i = 1; i <= theRemovedEdges.Length(); i++)
{
TopoDS_Edge anEdge = TopoDS::Edge(theRemovedEdges(i));
if (anEdge.IsSame(theCurEdge))
{
continue;
}
double Param1, Param2;
occ::handle<Geom2d_Curve> aPC = BRep_Tool::CurveOnSurface(anEdge, theFrefFace, Param1, Param2);
if (aPC.IsNull())
{
continue;
}
TopoDS_Vertex aFirstVertex, aLastVertex;
TopExp::Vertices(anEdge, aFirstVertex, aLastVertex, true);
if ((aFirstVertex.IsSame(theCurVertex) || aLastVertex.IsSame(theCurVertex))
&& BRep_Tool::IsClosed(anEdge, theFrefFace))
{
double aParam = (anEdge.Orientation() == TopAbs_FORWARD) ? Param1 : Param2;
gp_Pnt2d aPoint = aPC->Value(aParam);
double aUdiff = std::abs(aPoint.X() - theCurPoint.X());
double aVdiff = std::abs(aPoint.Y() - theCurPoint.Y());
if ((theUperiod != 0. && aUdiff > theUperiod / 2)
|| (theVperiod != 0. && aVdiff > theVperiod / 2))
{
if (aLastVertex.IsSame(theCurVertex) || (theUperiod != 0. && theVperiod != 0.))
{
anEdge.Reverse();
}
else
{
TopAbs_Orientation anOri = anEdge.Orientation();
anEdge.Orientation(TopAbs_FORWARD);
occ::handle<Geom2d_Curve> aPC1 =
BRep_Tool::CurveOnSurface(anEdge, theFrefFace, Param1, Param2);
anEdge.Reverse();
occ::handle<Geom2d_Curve> aPC2 =
BRep_Tool::CurveOnSurface(anEdge, theFrefFace, Param1, Param2);
anEdge.Reverse(); // again FORWARD
TopLoc_Location aLoc;
BRep_Builder aBB;
double aTol = BRep_Tool::Tolerance(anEdge);
const occ::handle<Geom_Surface>& aSurf = BRep_Tool::Surface(theFrefFace, aLoc);
aBB.UpdateEdge(anEdge, aPC2, aPC1, aSurf, aLoc, aTol);
anEdge.Orientation(anOri);
}
aPC = BRep_Tool::CurveOnSurface(anEdge, theFrefFace, Param1, Param2);
aParam = (anEdge.Orientation() == TopAbs_FORWARD) ? Param1 : Param2;
aPoint = aPC->Value(aParam);
aUdiff = std::abs(aPoint.X() - theCurPoint.X());
aVdiff = std::abs(aPoint.Y() - theCurPoint.Y());
}
if ((theUperiod == 0. || aUdiff < theUperiod / 2)
&& (theVperiod == 0. || aVdiff < theVperiod / 2))
{
aFirstVertex = TopExp::FirstVertex(anEdge, true);
if (aFirstVertex.IsSame(theCurVertex))
{
theSeamEdge = anEdge;
break;
}
}
}
}
if (!theSeamEdge.IsNull())
{
double Param1, Param2;
occ::handle<Geom2d_Curve> aPC =
BRep_Tool::CurveOnSurface(theSeamEdge, theFrefFace, Param1, Param2);
double aParam = (theSeamEdge.Orientation() == TopAbs_FORWARD) ? Param2 : Param1;
theNextPoint = aPC->Value(aParam);
}
}
//=================================================================================================
static bool SameSurf(const occ::handle<Geom_Surface>& theS1, const occ::handle<Geom_Surface>& theS2)
{
constexpr double aCoefs[2] = {0.3399811, 0.7745966};
double uf1, ul1, vf1, vl1, uf2, ul2, vf2, vl2;
theS1->Bounds(uf1, ul1, vf1, vl1);
theS2->Bounds(uf2, ul2, vf2, vl2);
constexpr double aPTol = Precision::PConfusion();
if (Precision::IsNegativeInfinite(uf1))
{
if (!Precision::IsNegativeInfinite(uf2))
{
return false;
}
else
{
uf1 = std::min(-1., (ul1 - 1.));
}
}
else
{
if (Precision::IsNegativeInfinite(uf2))
{
return false;
}
else
{
if (std::abs(uf1 - uf2) > aPTol)
{
return false;
}
}
}
//
if (Precision::IsNegativeInfinite(vf1))
{
if (!Precision::IsNegativeInfinite(vf2))
{
return false;
}
else
{
vf1 = std::min(-1., (vl1 - 1.));
}
}
else
{
if (Precision::IsNegativeInfinite(vf2))
{
return false;
}
else
{
if (std::abs(vf1 - vf2) > aPTol)
{
return false;
}
}
}
//
if (Precision::IsPositiveInfinite(ul1))
{
if (!Precision::IsPositiveInfinite(ul2))
{
return false;
}
else
{
ul1 = std::max(1., (uf1 + 1.));
}
}
else
{
if (Precision::IsPositiveInfinite(ul2))
{
return false;
}
else
{
if (std::abs(ul1 - ul2) > aPTol)
{
return false;
}
}
}
//
if (Precision::IsPositiveInfinite(vl1))
{
if (!Precision::IsPositiveInfinite(vl2))
{
return false;
}
else
{
vl1 = std::max(1., (vf1 + 1.));
}
}
else
{
if (Precision::IsPositiveInfinite(vl2))
{
return false;
}
else
{
if (std::abs(vl1 - vl2) > aPTol)
{
return false;
}
}
}
//
double u, v, du = (ul1 - uf1), dv = (vl1 - vf1);
int i, j;
for (i = 0; i < 2; ++i)
{
u = uf1 + aCoefs[i] * du;
for (j = 0; j < 2; ++j)
{
v = vf1 + aCoefs[j] * dv;
gp_Pnt aP1 = theS1->Value(u, v);
gp_Pnt aP2 = theS2->Value(u, v);
if (!aP1.IsEqual(aP2, aPTol))
{
return false;
}
}
}
return true;
}
//=================================================================================================
static void TransformPCurves(
const TopoDS_Face& theRefFace,
const TopoDS_Face& theFace,
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& theMapEdgesWithTemporaryPCurves)
{
occ::handle<Geom_Surface> RefSurf = BRep_Tool::Surface(theRefFace);
if (RefSurf->IsKind(STANDARD_TYPE(Geom_RectangularTrimmedSurface)))
{
RefSurf = (occ::down_cast<Geom_RectangularTrimmedSurface>(RefSurf))->BasisSurface();
}
occ::handle<Geom_Surface> SurfFace = BRep_Tool::Surface(theFace);
if (SurfFace->IsKind(STANDARD_TYPE(Geom_RectangularTrimmedSurface)))
{
SurfFace = (occ::down_cast<Geom_RectangularTrimmedSurface>(SurfFace))->BasisSurface();
}
bool ToModify = false, ToTranslate = false, ToRotate = false, X_Reverse = false,
Y_Reverse = false, ToProject = false;
double aTranslation = 0., anAngle = 0.;
// Get axes of surface of face and of surface of RefFace
occ::handle<Geom_ElementarySurface> ElemSurfFace =
occ::down_cast<Geom_ElementarySurface>(SurfFace);
occ::handle<Geom_ElementarySurface> ElemRefSurf = occ::down_cast<Geom_ElementarySurface>(RefSurf);
if (!ElemSurfFace.IsNull() && !ElemRefSurf.IsNull())
{
gp_Ax3 AxisOfSurfFace = ElemSurfFace->Position();
gp_Ax3 AxisOfRefSurf = ElemRefSurf->Position();
gp_Pnt OriginRefSurf = AxisOfRefSurf.Location();
double aParam = ElCLib::LineParameter(AxisOfSurfFace.Axis(), OriginRefSurf);
if (std::abs(aParam) > Precision::PConfusion())
{
aTranslation = -aParam;
}
gp_Dir VdirSurfFace = AxisOfSurfFace.Direction();
gp_Dir VdirRefSurf = AxisOfRefSurf.Direction();
gp_Dir XdirSurfFace = AxisOfSurfFace.XDirection();
gp_Dir XdirRefSurf = AxisOfRefSurf.XDirection();
gp_Dir CrossProd1 = AxisOfRefSurf.XDirection() ^ AxisOfRefSurf.YDirection();
gp_Dir CrossProd2 = AxisOfSurfFace.XDirection() ^ AxisOfSurfFace.YDirection();
if (CrossProd1 * CrossProd2 < 0.)
{
X_Reverse = true;
}
double ScalProd = VdirSurfFace * VdirRefSurf;
if (ScalProd < 0.)
{
Y_Reverse = true;
}
if (!X_Reverse && !Y_Reverse)
{
gp_Dir DirRef = VdirRefSurf;
if (!AxisOfRefSurf.Direct())
{
DirRef.Reverse();
}
anAngle = XdirRefSurf.AngleWithRef(XdirSurfFace, DirRef);
}
else
{
anAngle = XdirRefSurf.Angle(XdirSurfFace);
}
ToRotate = (std::abs(anAngle) > Precision::PConfusion());
ToTranslate = (std::abs(aTranslation) > Precision::PConfusion());
ToModify = ToTranslate || ToRotate || X_Reverse || Y_Reverse;
}
else
{
if (!SameSurf(RefSurf, SurfFace))
{
ToProject = true;
}
}
BRep_Builder BB;
TopExp_Explorer Explo(theFace, TopAbs_EDGE);
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> aEmap;
for (; Explo.More(); Explo.Next())
{
TopoDS_Edge anEdge = TopoDS::Edge(Explo.Current());
if (BRep_Tool::Degenerated(anEdge) && ToModify)
{
continue;
}
if (ToProject && BRep_Tool::IsClosed(anEdge, theFace))
{
continue;
}
if (!aEmap.Add(anEdge))
{
continue;
}
TopAbs_Orientation anOr = anEdge.Orientation();
double fpar, lpar;
occ::handle<Geom2d_Curve> PCurveOnRef =
BRep_Tool::CurveOnSurface(anEdge, theRefFace, fpar, lpar);
occ::handle<Geom2d_Curve> PCurve2;
if (!PCurveOnRef.IsNull() /* && !(ToModify || ToProject)*/)
{
anEdge.Reverse();
PCurve2 = BRep_Tool::CurveOnSurface(anEdge, theRefFace, fpar, lpar);
if (PCurve2 != PCurveOnRef)
{ // two pcurves
continue;
}
}
occ::handle<Geom2d_Curve> PCurves[2], NewPCurves[2];
anEdge.Orientation(TopAbs_FORWARD);
PCurves[0] = BRep_Tool::CurveOnSurface(anEdge, theFace, fpar, lpar);
anEdge.Reverse();
PCurves[1] = BRep_Tool::CurveOnSurface(anEdge, theFace, fpar, lpar);
if (PCurves[0].IsNull() || PCurves[1].IsNull())
{
// The source face has no pcurve for this edge, so it cannot be transformed.
continue;
}
int NbPcurves = (PCurves[0] == PCurves[1]) ? 1 : 2;
for (int ii = 0; ii < NbPcurves; ii++)
{
if (ToProject)
{
occ::handle<Geom_Curve> aC3d = BRep_Tool::Curve(anEdge, fpar, lpar);
aC3d = new Geom_TrimmedCurve(aC3d, fpar, lpar);
double tol = BRep_Tool::Tolerance(anEdge);
tol = std::min(tol, Precision::Approximation());
NewPCurves[ii] = GeomProjLib::Curve2d(aC3d, RefSurf);
}
else
{
NewPCurves[ii] = occ::down_cast<Geom2d_Curve>(PCurves[ii]->Copy());
}
if (ToTranslate)
{
NewPCurves[ii]->Translate(gp_Vec2d(0., aTranslation));
}
if (Y_Reverse)
{
NewPCurves[ii]->Mirror(gp::OX2d());
}
if (X_Reverse)
{
NewPCurves[ii]->Mirror(gp::OY2d());
NewPCurves[ii]->Translate(gp_Vec2d(2 * M_PI, 0.));
}
if (ToRotate)
{
NewPCurves[ii]->Translate(gp_Vec2d(anAngle, 0.));
}
}
anEdge.Orientation(TopAbs_FORWARD);
if (NbPcurves == 1)
{
if (PCurve2.IsNull() || (!RefSurf->IsUClosed() && !RefSurf->IsVClosed()))
{
BB.UpdateEdge(anEdge, NewPCurves[0], theRefFace, 0.);
theMapEdgesWithTemporaryPCurves.Add(anEdge);
}
else
{
// check: may be it is the same pcurve
double aUmin, aUmax, aVmin, aVmax;
RefSurf->Bounds(aUmin, aUmax, aVmin, aVmax);
double aUperiod = (RefSurf->IsUClosed()) ? (aUmax - aUmin) : 0.;
double aVperiod = (RefSurf->IsVClosed()) ? (aVmax - aVmin) : 0.;
gp_Pnt2d aP2dOnPCurve1 = PCurveOnRef->Value(fpar);
gp_Pnt2d aP2dOnPCurve2 = NewPCurves[0]->Value(fpar);
if ((aUperiod != 0. && std::abs(aP2dOnPCurve1.X() - aP2dOnPCurve2.X()) > aUperiod / 2)
|| (aVperiod != 0. && std::abs(aP2dOnPCurve1.Y() - aP2dOnPCurve2.Y()) > aVperiod / 2))
{
occ::handle<Geom2d_Curve> NullPCurve;
BB.UpdateEdge(anEdge, NullPCurve, theRefFace, 0.);
if (anOr == TopAbs_FORWARD)
{
BB.UpdateEdge(anEdge, NewPCurves[0], PCurveOnRef, theRefFace, 0.);
}
else
{
BB.UpdateEdge(anEdge, PCurveOnRef, NewPCurves[0], theRefFace, 0.);
}
theMapEdgesWithTemporaryPCurves.Add(anEdge);
}
}
}
else
{
BB.UpdateEdge(anEdge, NewPCurves[0], NewPCurves[1], theRefFace, 0.);
theMapEdgesWithTemporaryPCurves.Add(anEdge);
}
BB.Range(anEdge, fpar, lpar);
}
}
//=================================================================================================
static void AddPCurves(
const NCollection_Sequence<TopoDS_Shape>& theFaces,
const TopoDS_Face& theRefFace,
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& theMapEdgesWithTemporaryPCurves)
{
BRepAdaptor_Surface RefBAsurf(theRefFace, false);
GeomAbs_SurfaceType aType = RefBAsurf.GetType();
if (aType == GeomAbs_Plane)
{
return;
}
for (int i = 1; i <= theFaces.Length(); i++)
{
TopoDS_Face aFace = TopoDS::Face(theFaces(i));
aFace.Orientation(TopAbs_FORWARD);
if (aFace.IsSame(theRefFace))
{
continue;
}
TransformPCurves(theRefFace, aFace, theMapEdgesWithTemporaryPCurves);
}
}
//=================================================================================================
// adds edges from the shape to the sequence
// seams and equal edges are dropped
// Returns true if one of original edges dropped
static bool AddOrdinaryEdges(NCollection_Sequence<TopoDS_Shape>& edges,
const TopoDS_Shape& aShape,
int& anIndex,
NCollection_Sequence<TopoDS_Shape>& theRemovedEdges)
{
// map of edges
NCollection_IndexedMap<TopoDS_Shape, TopTools_ShapeMapHasher> aNewEdges;
// add edges without seams
for (TopExp_Explorer exp(aShape, TopAbs_EDGE); exp.More(); exp.Next())
{
const TopoDS_Shape& edge = exp.Current();
if (aNewEdges.Contains(edge))
{
aNewEdges.RemoveKey(edge);
theRemovedEdges.Append(edge);
}
else
{
aNewEdges.Add(edge);
}
}
bool isDropped = false;
// merge edges and drop seams
int i;
for (i = 1; i <= edges.Length(); i++)
{
TopoDS_Shape current = edges(i);
if (aNewEdges.Contains(current))
{
aNewEdges.RemoveKey(current);
edges.Remove(i);
theRemovedEdges.Append(current);
i--;
if (!isDropped)
{
isDropped = true;
anIndex = i;
}
}
}
// add edges to the sequence
for (i = 1; i <= aNewEdges.Extent(); i++)
{
edges.Append(aNewEdges(i));
}
return isDropped;
}
//=================================================================================================
static bool getCylinder(occ::handle<Geom_Surface>& theInSurface, gp_Cylinder& theOutCylinder)
{
bool isCylinder = false;
if (theInSurface->IsKind(STANDARD_TYPE(Geom_CylindricalSurface)))
{
occ::handle<Geom_CylindricalSurface> aGC =
occ::down_cast<Geom_CylindricalSurface>(theInSurface);
theOutCylinder = aGC->Cylinder();
isCylinder = true;
}
else if (theInSurface->IsKind(STANDARD_TYPE(Geom_SurfaceOfRevolution)))
{
occ::handle<Geom_SurfaceOfRevolution> aRS =
occ::down_cast<Geom_SurfaceOfRevolution>(theInSurface);
occ::handle<Geom_Curve> aBasis = aRS->BasisCurve();
while (aBasis->IsKind(STANDARD_TYPE(Geom_TrimmedCurve)))
{
occ::handle<Geom_TrimmedCurve> aTc = occ::down_cast<Geom_TrimmedCurve>(aBasis);
aBasis = aTc->BasisCurve();
}
if (aBasis->IsKind(STANDARD_TYPE(Geom_Line)))
{
occ::handle<Geom_Line> aBasisLine = occ::down_cast<Geom_Line>(aBasis);
gp_Dir aDir = aRS->Direction();
gp_Dir aBasisDir = aBasisLine->Position().Direction();
if (aBasisDir.IsParallel(aDir, Precision::Angular()))
{
// basis line is parallel to the revolution axis: it is a cylinder
gp_Pnt aLoc = aRS->Location();
double aR = aBasisLine->Lin().Distance(aLoc);
gp_Ax3 aCylAx(aLoc, aDir);
theOutCylinder = gp_Cylinder(aCylAx, aR);
isCylinder = true;
}
}
}
else if (theInSurface->IsKind(STANDARD_TYPE(Geom_SurfaceOfLinearExtrusion)))
{
occ::handle<Geom_SurfaceOfLinearExtrusion> aLES =
occ::down_cast<Geom_SurfaceOfLinearExtrusion>(theInSurface);
occ::handle<Geom_Curve> aBasis = aLES->BasisCurve();
while (aBasis->IsKind(STANDARD_TYPE(Geom_TrimmedCurve)))
{
occ::handle<Geom_TrimmedCurve> aTc = occ::down_cast<Geom_TrimmedCurve>(aBasis);
aBasis = aTc->BasisCurve();
}
if (aBasis->IsKind(STANDARD_TYPE(Geom_Circle)))
{
occ::handle<Geom_Circle> aBasisCircle = occ::down_cast<Geom_Circle>(aBasis);
gp_Dir aDir = aLES->Direction();
gp_Dir aBasisDir = aBasisCircle->Position().Direction();
if (aBasisDir.IsParallel(aDir, Precision::Angular()))
{
// basis circle is normal to the extrusion axis: it is a cylinder
gp_Pnt aLoc = aBasisCircle->Location();
double aR = aBasisCircle->Radius();
gp_Ax3 aCylAx(aLoc, aDir);
theOutCylinder = gp_Cylinder(aCylAx, aR);
isCylinder = true;
}
}
}
else
{
}
return isCylinder;
}
//=================================================================================================
static occ::handle<Geom_Surface> ClearRts(const occ::handle<Geom_Surface>& aSurface)
{
const occ::handle<Geom_RectangularTrimmedSurface> aRTS =
occ::down_cast<Geom_RectangularTrimmedSurface>(aSurface);
return aRTS.IsNull() ? aSurface : aRTS->BasisSurface();
}
//=======================================================================
// function : GetNormalToSurface
// purpose : Gets the normal to surface by the given parameter on edge.
// Returns True if normal was computed.
//=======================================================================
static bool GetNormalToSurface(const TopoDS_Face& theFace,
const TopoDS_Edge& theEdge,
const double theP,
gp_Dir& theNormal)
{
double f, l;
// get 2d curve to get point in 2d
occ::handle<Geom2d_Curve> aC2d;
if (BRep_Tool::IsClosed(theEdge, theFace))
{
// Find the edge in the face: it will have correct orientation
TopoDS_Edge anEdgeInFace;
TopoDS_Face aFace = theFace;
aFace.Orientation(TopAbs_FORWARD);
TopExp_Explorer anExplo(aFace, TopAbs_EDGE);
for (; anExplo.More(); anExplo.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(anExplo.Current());
if (anEdge.IsSame(theEdge))
{
anEdgeInFace = anEdge;
break;
}
}
if (anEdgeInFace.IsNull())
{
return false;
}
aC2d = BRep_Tool::CurveOnSurface(anEdgeInFace, aFace, f, l);
}
else
{
aC2d = BRep_Tool::CurveOnSurface(theEdge, theFace, f, l);
}
if (aC2d.IsNull())
{
return false;
}
//
// 2d point
gp_Pnt2d aP2d;
aC2d->D0(theP, aP2d);
//
// get D1
gp_Vec aDU, aDV;
gp_Pnt aP3d;
TopLoc_Location aLoc;
const occ::handle<Geom_Surface>& aS = BRep_Tool::Surface(theFace, aLoc);
aS->D1(aP2d.X(), aP2d.Y(), aP3d, aDU, aDV);
//
// compute normal
gp_Vec aVNormal = aDU.Crossed(aDV);
if (aVNormal.Magnitude() < Precision::Confusion())
{
return false;
}
//
if (theFace.Orientation() == TopAbs_REVERSED)
{
aVNormal.Reverse();
}
//
aVNormal.Transform(aLoc.Transformation());
theNormal = gp_Dir(aVNormal);
return true;
}
//=================================================================================================
static bool IsSameDomain(const TopoDS_Face& aFace,
const TopoDS_Face& aCheckedFace,
const double theLinTol,
const double theAngTol,
ShapeUpgrade_UnifySameDomain::DataMapOfFacePlane& theFacePlaneMap)
{
// checking the same handles
TopLoc_Location L1, L2;
occ::handle<Geom_Surface> S1, S2;
S1 = BRep_Tool::Surface(aFace, L1);
S2 = BRep_Tool::Surface(aCheckedFace, L2);
if (S1 == S2 && L1 == L2)
{
return true;
}
S1 = BRep_Tool::Surface(aFace);
S2 = BRep_Tool::Surface(aCheckedFace);
S1 = ClearRts(S1);
S2 = ClearRts(S2);
// occ::handle<Geom_OffsetSurface> aGOFS1, aGOFS2;
// aGOFS1 = occ::down_cast<Geom_OffsetSurface>(S1);
// aGOFS2 = occ::down_cast<Geom_OffsetSurface>(S2);
// if (!aGOFS1.IsNull()) S1 = aGOFS1->BasisSurface();
// if (!aGOFS2.IsNull()) S2 = aGOFS2->BasisSurface();
// case of two planar surfaces:
// all kinds of surfaces checked, including b-spline and bezier
GeomLib_IsPlanarSurface aPlanarityChecker1(S1, theLinTol);
if (aPlanarityChecker1.IsPlanar())
{
GeomLib_IsPlanarSurface aPlanarityChecker2(S2, theLinTol);
if (aPlanarityChecker2.IsPlanar())
{
gp_Pln aPln1 = aPlanarityChecker1.Plan();
gp_Pln aPln2 = aPlanarityChecker2.Plan();
if (aPln1.Position().Direction().IsParallel(aPln2.Position().Direction(), theAngTol)
&& aPln1.Distance(aPln2) < theLinTol)
{
occ::handle<Geom_Plane> aPlaneOfFaces;
if (theFacePlaneMap.IsBound(aFace))
{
aPlaneOfFaces = theFacePlaneMap(aFace);
}
else if (theFacePlaneMap.IsBound(aCheckedFace))
{
aPlaneOfFaces = theFacePlaneMap(aCheckedFace);
}
else
{
aPlaneOfFaces = new Geom_Plane(aPln1);
}
theFacePlaneMap.Bind(aFace, aPlaneOfFaces);
theFacePlaneMap.Bind(aCheckedFace, aPlaneOfFaces);
return true;
}
}
}
// case of two elementary surfaces: use OCCT tool
// elementary surfaces: ConicalSurface, CylindricalSurface,
// Plane, SphericalSurface and ToroidalSurface
if (S1->IsKind(STANDARD_TYPE(Geom_ElementarySurface))
&& S2->IsKind(STANDARD_TYPE(Geom_ElementarySurface)))
{
occ::handle<GeomAdaptor_Surface> aGA1 = new GeomAdaptor_Surface(S1);
occ::handle<GeomAdaptor_Surface> aGA2 = new GeomAdaptor_Surface(S2);
occ::handle<BRepTopAdaptor_TopolTool> aTT1 = new BRepTopAdaptor_TopolTool();
occ::handle<BRepTopAdaptor_TopolTool> aTT2 = new BRepTopAdaptor_TopolTool();
try
{
IntPatch_ImpImpIntersection anIIInt(aGA1, aTT1, aGA2, aTT2, theLinTol, theLinTol);
if (!anIIInt.IsDone() || anIIInt.IsEmpty())
{
return false;
}
return anIIInt.TangentFaces();
}
catch (Standard_Failure const&)
{
return false;
}
}
// case of two cylindrical surfaces, at least one of which is a swept surface
// swept surfaces: SurfaceOfLinearExtrusion, SurfaceOfRevolution
if ((S1->IsKind(STANDARD_TYPE(Geom_CylindricalSurface))
|| S1->IsKind(STANDARD_TYPE(Geom_SweptSurface)))
&& (S2->IsKind(STANDARD_TYPE(Geom_CylindricalSurface))
|| S2->IsKind(STANDARD_TYPE(Geom_SweptSurface))))
{
gp_Cylinder aCyl1, aCyl2;
if (getCylinder(S1, aCyl1) && getCylinder(S2, aCyl2))
{
if (fabs(aCyl1.Radius() - aCyl2.Radius()) < theLinTol)
{
gp_Dir aDir1 = aCyl1.Position().Direction();
gp_Dir aDir2 = aCyl2.Position().Direction();
if (aDir1.IsParallel(aDir2, Precision::Angular()))
{
gp_Pnt aLoc1 = aCyl1.Location();
gp_Pnt aLoc2 = aCyl2.Location();
gp_Vec aVec12(aLoc1, aLoc2);
if (aVec12.SquareMagnitude() < theLinTol * theLinTol
|| aVec12.IsParallel(aDir1, Precision::Angular()))
{
return true;
}
}
}
}
}
return false;
}
//=================================================================================================
static void UpdateMapOfShapes(
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& theMapOfShapes,
occ::handle<ShapeBuild_ReShape>& theContext)
{
for (NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>::Iterator it(theMapOfShapes);
it.More();
it.Next())
{
const TopoDS_Shape& aShape = it.Value();
TopoDS_Shape aContextShape = theContext->Apply(aShape);
if (!aContextShape.IsSame(aShape))
{
theMapOfShapes.Add(aContextShape);
}
}
}
//=======================================================================
// function : GlueEdgesWith3DCurves
// purpose : Glues 3d curves of the sequence of edges
//=======================================================================
static TopoDS_Edge GlueEdgesWith3DCurves(const NCollection_Sequence<TopoDS_Shape>& aChain,
const TopoDS_Vertex& FirstVertex,
const TopoDS_Vertex& LastVertex)
{
// number of curves
const int aCurveCount = aChain.Length();
TopoDS_Edge aPrevEdge = TopoDS::Edge(aChain(1));
TopoDS_Vertex aPrevVertex = FirstVertex;
double aMaxTolerance = 0.;
// array of the curves converted to BSpline
NCollection_Array1<occ::handle<Geom_BSplineCurve>> aBSplines(0, aCurveCount - 1);
// array of the tolerances at the vertices
NCollection_Array1<double> aVerticesTolerances(0, aCurveCount - 1);
for (int i = 1; i <= aCurveCount; ++i)
{
const TopoDS_Edge aCurrentEdge = TopoDS::Edge(aChain(i));
TopoDS_Vertex aCurrentFirstVertex, aCurrentLastVertex;
TopExp::Vertices(aCurrentEdge, aCurrentFirstVertex, aCurrentLastVertex);
const bool aToReverse = !aCurrentFirstVertex.IsSame(aPrevVertex);
aMaxTolerance = std::max({aMaxTolerance,
BRep_Tool::Tolerance(aCurrentFirstVertex),
BRep_Tool::Tolerance(aCurrentLastVertex)});
if (i > 1)
{
TopoDS_Vertex aCommonVertex;
TopExp::CommonVertex(aPrevEdge, aCurrentEdge, aCommonVertex);
aVerticesTolerances(i - 2) = BRep_Tool::Tolerance(aCommonVertex);
}
double aFirstParam, aLastParam;
const occ::handle<Geom_Curve> aCurrentCurve =
BRep_Tool::Curve(aCurrentEdge, aFirstParam, aLastParam);
const occ::handle<Geom_TrimmedCurve> aTrimmedCurve =
new Geom_TrimmedCurve(aCurrentCurve, aFirstParam, aLastParam);
aBSplines(i - 1) = GeomConvert::CurveToBSplineCurve(aTrimmedCurve);
GeomConvert::C0BSplineToC1BSplineCurve(aBSplines(i - 1), Precision::Confusion());
if (aToReverse)
{
aBSplines(i - 1)->Reverse();
}
aPrevVertex = aToReverse ? aCurrentFirstVertex : aCurrentLastVertex;
aPrevEdge = aCurrentEdge;
}
// Array of the concatenated curves.
occ::handle<NCollection_HArray1<occ::handle<Geom_BSplineCurve>>> aConcatCurves;
// Array of the remaining Vertex, effectively ignored here.
occ::handle<NCollection_HArray1<int>> anArrayOfIndices;
// Flag of closedness of the concatenated curve, effectively ignored here.
bool aClosedFlag = false;
GeomConvert::ConcatC1(aBSplines,
aVerticesTolerances,
anArrayOfIndices,
aConcatCurves,
aClosedFlag,
Precision::Confusion()); // C1 concatenation
if (aConcatCurves->Length() > 1)
{
GeomConvert_CompCurveToBSplineCurve Concat(aConcatCurves->Value(aConcatCurves->Lower()));
for (int i = aConcatCurves->Lower() + 1; i <= aConcatCurves->Upper(); ++i)
{
Concat.Add(aConcatCurves->Value(i), aMaxTolerance, true);
}
aConcatCurves->SetValue(aConcatCurves->Lower(), Concat.BSplineCurve());
}
occ::handle<Geom_BSplineCurve> aResCurve = aConcatCurves->Value(aConcatCurves->Lower());
const TopoDS_Edge aResEdge = BRepLib_MakeEdge(aResCurve,
FirstVertex,
LastVertex,
aResCurve->FirstParameter(),
aResCurve->LastParameter());
BRep_Builder aBuilder;
aBuilder.SameRange(aResEdge, false);
aBuilder.SameParameter(aResEdge, false);
BRepLib::SameParameter(aResEdge, aMaxTolerance, true);
return aResEdge;
}
//=================================================================================================
void ShapeUpgrade_UnifySameDomain::UnionPCurves(const NCollection_Sequence<TopoDS_Shape>& theChain,
TopoDS_Edge& theEdge)
{
double aFirst3d, aLast3d;
occ::handle<Geom_Curve> aCurve = BRep_Tool::Curve(theEdge, aFirst3d, aLast3d);
double aTolEdge = BRep_Tool::Tolerance(theEdge);
double aMaxTol = aTolEdge;
NCollection_Sequence<TopoDS_Shape> aFaceSeq;
const TopoDS_Edge& aFirstEdge = TopoDS::Edge(theChain.Value(1));
const NCollection_List<TopoDS_Shape>& aFaceList = myEFmap.FindFromKey(aFirstEdge);
NCollection_List<TopoDS_Shape>::Iterator anItl(aFaceList);
for (; anItl.More(); anItl.Next())
{
TopoDS_Face aFace = TopoDS::Face(anItl.Value());
if (myFacePlaneMap.IsBound(aFace))
{
continue;
}
if (myFaceNewFace.IsBound(aFace))
{
aFace = TopoDS::Face(myFaceNewFace(aFace));
}
aFace.Orientation(TopAbs_FORWARD); // to get proper pcurves of seam edges
BRepAdaptor_Surface aBAsurf(aFace, false);
if (aBAsurf.GetType() == GeomAbs_Plane)
{
continue;
}
TopLoc_Location aLoc;
occ::handle<Geom_Surface> aSurf = BRep_Tool::Surface(aFace, aLoc);
bool isFound = false;
for (int ii = 1; ii <= aFaceSeq.Length(); ii++)
{
TopLoc_Location aPrevLoc;
occ::handle<Geom_Surface> aPrevSurf =
BRep_Tool::Surface(TopoDS::Face(aFaceSeq(ii)), aPrevLoc);
if (aPrevSurf == aSurf && aPrevLoc == aLoc)
{
isFound = true;
break;
}
}
if (isFound)
{
continue;
}
aFaceSeq.Append(aFace);
}
NCollection_Sequence<occ::handle<Geom2d_Curve>> ResPCurves;
NCollection_Sequence<double> ResFirsts;
NCollection_Sequence<double> ResLasts;
NCollection_Sequence<double> aTolVerSeq;
TopoDS_Edge aPrevEdge;
bool anIsSeam = false;
for (int j = 1; j <= aFaceSeq.Length(); j++)
{
NCollection_Sequence<occ::handle<Geom2d_Curve>> aPCurveSeq;
NCollection_Sequence<double> aFirstsSeq;
NCollection_Sequence<double> aLastsSeq;
NCollection_Sequence<bool> aForwardsSeq;
GeomAbs_CurveType aCurrentType = GeomAbs_OtherCurve;
double aFirst, aLast;
for (int i = 1; i <= theChain.Length(); i++)
{
TopoDS_Edge anEdge = TopoDS::Edge(theChain.Value(i));
bool isForward = (anEdge.Orientation() != TopAbs_REVERSED);
if (anIsSeam && j == 2)
{ // second pass
anEdge.Reverse();
}
occ::handle<Geom2d_Curve> aPCurve =
BRep_Tool::CurveOnSurface(anEdge, TopoDS::Face(aFaceSeq(j)), aFirst, aLast);
if (aPCurve.IsNull())
{
continue;
}
if (aFaceSeq.Length() == 1)
{
TopoDS_Edge aReversedEdge = anEdge;
aReversedEdge.Reverse();
occ::handle<Geom2d_Curve> aPCurve2 =
BRep_Tool::CurveOnSurface(aReversedEdge, TopoDS::Face(aFaceSeq(j)), aFirst, aLast);
if (aPCurve != aPCurve2)
{
anIsSeam = true;
aFaceSeq.Append(aFaceSeq(j));
}
}
Geom2dAdaptor_Curve anAdaptor(aPCurve);
GeomAbs_CurveType aType = anAdaptor.GetType();
occ::handle<Geom2d_Line> aLine;
if (aType == GeomAbs_BSplineCurve || aType == GeomAbs_BezierCurve)
{
TryMakeLine(aPCurve, aFirst, aLast, aLine);
}
if (!aLine.IsNull())
{
aPCurve = aLine;
anAdaptor.Load(aPCurve);
aType = GeomAbs_Line;
}
if (aPCurveSeq.IsEmpty())
{
occ::handle<Geom2d_Curve> aCopyPCurve = occ::down_cast<Geom2d_Curve>(aPCurve->Copy());
if (aCopyPCurve->IsKind(STANDARD_TYPE(Geom2d_TrimmedCurve)))
{
aCopyPCurve = (occ::down_cast<Geom2d_TrimmedCurve>(aCopyPCurve))->BasisCurve();
}
aPCurveSeq.Append(aCopyPCurve);
aFirstsSeq.Append(aFirst);
aLastsSeq.Append(aLast);
aForwardsSeq.Append(isForward);
aCurrentType = aType;
aPrevEdge = anEdge;
continue;
}
bool isSameCurve = false;
double aNewF = aFirst;
double aNewL = aLast;
if (aPCurve == aPCurveSeq.Last())
{
isSameCurve = true;
}
else if (aType == aCurrentType)
{
Geom2dAdaptor_Curve aPrevAdaptor(aPCurveSeq.Last());
switch (aType)
{
case GeomAbs_Line: {
gp_Lin2d aPrevLin = aPrevAdaptor.Line();
gp_Pnt2d aFirstP2d = aPCurve->Value(aFirst);
gp_Pnt2d aLastP2d = aPCurve->Value(aLast);
if (aPrevLin.Contains(aFirstP2d, Precision::Confusion())
&& aPrevLin.Contains(aLastP2d, Precision::Confusion()))
{
isSameCurve = true;
gp_Pnt2d p1 = anAdaptor.Value(aFirst);
gp_Pnt2d p2 = anAdaptor.Value(aLast);
aNewF = ElCLib::Parameter(aPrevLin, p1);
aNewL = ElCLib::Parameter(aPrevLin, p2);
if (aNewF > aNewL)
{
double aTmp = aNewF;
aNewF = aNewL;
aNewL = aTmp;
}
}
break;
}
case GeomAbs_Circle: {
gp_Circ2d aCirc = anAdaptor.Circle();
gp_Circ2d aPrevCirc = aPrevAdaptor.Circle();
if (aCirc.Location().Distance(aPrevCirc.Location()) <= Precision::Confusion()
&& std::abs(aCirc.Radius() - aPrevCirc.Radius()) <= Precision::Confusion())
{
isSameCurve = true;
gp_Pnt2d p1 = anAdaptor.Value(aFirst);
gp_Pnt2d p2 = anAdaptor.Value(aLast);
aNewF = ElCLib::Parameter(aPrevCirc, p1);
aNewL = ElCLib::Parameter(aPrevCirc, p2);
if (aNewF > aNewL)
{
double aTmp = aNewF;
aNewF = aNewL;
aNewL = aTmp;
}
}
break;
}
default:
break;
}
}
if (isSameCurve)
{
if (aForwardsSeq.Last())
{
aLastsSeq.ChangeLast() = aNewL;
}
else
{
aFirstsSeq.ChangeLast() = aNewF;
}
}
else
{
occ::handle<Geom2d_Curve> aCopyPCurve = occ::down_cast<Geom2d_Curve>(aPCurve->Copy());
if (aCopyPCurve->IsKind(STANDARD_TYPE(Geom2d_TrimmedCurve)))
{
aCopyPCurve = (occ::down_cast<Geom2d_TrimmedCurve>(aCopyPCurve))->BasisCurve();
}
aPCurveSeq.Append(aCopyPCurve);
aFirstsSeq.Append(aFirst);
aLastsSeq.Append(aLast);
aForwardsSeq.Append(isForward);
aCurrentType = aType;
TopoDS_Vertex aV;
TopExp::CommonVertex(aPrevEdge, anEdge, aV);
double aTol = BRep_Tool::Tolerance(aV);
aTolVerSeq.Append(aTol);
}
aPrevEdge = anEdge;
}
occ::handle<Geom2d_Curve> aResPCurve;
double aResFirst, aResLast;
if (aPCurveSeq.Length() == 1)
{
aResPCurve = aPCurveSeq.Last();
aResFirst = aFirstsSeq.Last();
aResLast = aLastsSeq.Last();
if (!aForwardsSeq.Last())
{
double aNewLast = aResPCurve->ReversedParameter(aResFirst);
double aNewFirst = aResPCurve->ReversedParameter(aResLast);
aResPCurve->Reverse();
aResFirst = aNewFirst;
aResLast = aNewLast;
}
}
else
{
// C1 concatenation for PCurveSeq
NCollection_Array1<occ::handle<Geom2d_BSplineCurve>> tab_c2d(0, aPCurveSeq.Length() - 1);
for (int i = 1; i <= aPCurveSeq.Length(); i++)
{
occ::handle<Geom2d_TrimmedCurve> aTrPCurve =
new Geom2d_TrimmedCurve(aPCurveSeq(i), aFirstsSeq(i), aLastsSeq(i));
if (!aForwardsSeq(i))
{
aTrPCurve->Reverse();
}
tab_c2d(i - 1) = Geom2dConvert::CurveToBSplineCurve(aTrPCurve);
Geom2dConvert::C0BSplineToC1BSplineCurve(tab_c2d(i - 1), Precision::Confusion());
}
NCollection_Array1<double> tabtolvertex(0, aTolVerSeq.Length() - 1);
for (int i = 1; i <= aTolVerSeq.Length(); i++)
{
double aTol = aTolVerSeq(i);
tabtolvertex(i - 1) = aTol;
if (aTol > aMaxTol)
{
aMaxTol = aTol;
}
}
occ::handle<NCollection_HArray1<occ::handle<Geom2d_BSplineCurve>>>
concatc2d; // array of the concatenated curves
occ::handle<NCollection_HArray1<int>> ArrayOfInd2d; // array of the remaining Vertex
bool aClosedFlag = false;
Geom2dConvert::ConcatC1(tab_c2d,
tabtolvertex,
ArrayOfInd2d,
concatc2d,
aClosedFlag,
Precision::Confusion()); // C1 concatenation
if (concatc2d->Length() > 1)
{
Geom2dConvert_CompCurveToBSplineCurve Concat2d(concatc2d->Value(concatc2d->Lower()));
for (int i = concatc2d->Lower() + 1; i <= concatc2d->Upper(); i++)
{
Concat2d.Add(concatc2d->Value(i), aMaxTol, true);
}
concatc2d->SetValue(concatc2d->Lower(), Concat2d.BSplineCurve());
}
occ::handle<Geom2d_BSplineCurve> aBSplineCurve = concatc2d->Value(concatc2d->Lower());
aResPCurve = aBSplineCurve;
aResFirst = aBSplineCurve->FirstParameter();
aResLast = aBSplineCurve->LastParameter();
}
ResPCurves.Append(aResPCurve);
ResFirsts.Append(aResFirst);
ResLasts.Append(aResLast);
}
BRep_Builder aBuilder;
// Check the results for consistency
bool IsBadRange = false;
double aRange3d = aLast3d - aFirst3d;
for (int ii = 1; ii <= ResPCurves.Length(); ii++)
{
double aRange = ResLasts(ii) - ResFirsts(ii);
if (std::abs(aRange3d - aRange) > aMaxTol)
{
IsBadRange = true;
}
}
if (IsBadRange)
{
for (int ii = 1; ii <= ResPCurves.Length(); ii++)
{
const TopoDS_Face& aFace = TopoDS::Face(aFaceSeq(ii));
occ::handle<Geom_Surface> aSurf = BRep_Tool::Surface(aFace);
occ::handle<ShapeAnalysis_Surface> aSAS = new ShapeAnalysis_Surface(aSurf);
ShapeConstruct_ProjectCurveOnSurface aToolProj;
aToolProj.Init(aSAS, Precision::Confusion());
occ::handle<Geom2d_Curve> aNewPCurve;
if (aToolProj.Perform(aCurve, aFirst3d, aLast3d, aNewPCurve))
{
ResPCurves(ii) = aNewPCurve;
}
else
{
// Reparametrize pcurve
occ::handle<Geom2d_TrimmedCurve> aTrPCurve =
new Geom2d_TrimmedCurve(ResPCurves(ii), ResFirsts(ii), ResLasts(ii));
occ::handle<Geom2d_BSplineCurve> aBSplinePCurve =
Geom2dConvert::CurveToBSplineCurve(aTrPCurve);
NCollection_Array1<double> aKnots(aBSplinePCurve->Knots());
BSplCLib::Reparametrize(aFirst3d, aLast3d, aKnots);
aBSplinePCurve->SetKnots(aKnots);
ResPCurves(ii) = aBSplinePCurve;
}
ResFirsts(ii) = aFirst3d;
ResLasts(ii) = aLast3d;
}
}
// Reparametrize pcurves if needed
if (!ResPCurves.IsEmpty())
{
for (int ii = 1; ii <= ResPCurves.Length(); ii++)
{
if (std::abs(aFirst3d - ResFirsts(ii)) > aMaxTol
|| std::abs(aLast3d - ResLasts(ii)) > aMaxTol)
{
Geom2dAdaptor_Curve aGAcurve(ResPCurves(ii));
GeomAbs_CurveType aType = aGAcurve.GetType();
if (aType == GeomAbs_Line)
{
gp_Lin2d aLin2d = aGAcurve.Line();
gp_Dir2d aDir2d = aLin2d.Direction();
gp_Pnt2d aPnt2d = aGAcurve.Value(ResFirsts(ii));
gp_Vec2d anOffset = -aDir2d;
anOffset *= aFirst3d;
aPnt2d.Translate(anOffset);
occ::handle<Geom2d_Line> aNewLine2d = new Geom2d_Line(aPnt2d, aDir2d);
ResPCurves(ii) = aNewLine2d;
}
else if (aType == GeomAbs_Circle)
{
gp_Circ2d aCirc2d = aGAcurve.Circle();
double aRadius = aCirc2d.Radius();
gp_Ax22d aPosition = aCirc2d.Position();
gp_Pnt2d aLocation = aCirc2d.Location();
double anOffset = ResFirsts(ii) - aFirst3d;
aPosition.Rotate(aLocation, anOffset);
occ::handle<Geom2d_Circle> aNewCircle2d = new Geom2d_Circle(aPosition, aRadius);
ResPCurves(ii) = aNewCircle2d;
}
else // general case
{
occ::handle<Geom2d_TrimmedCurve> aTrPCurve =
new Geom2d_TrimmedCurve(ResPCurves(ii), ResFirsts(ii), ResLasts(ii));
occ::handle<Geom2d_BSplineCurve> aBSplinePCurve =
Geom2dConvert::CurveToBSplineCurve(aTrPCurve);
NCollection_Array1<double> aKnots(aBSplinePCurve->Knots());
BSplCLib::Reparametrize(aFirst3d, aLast3d, aKnots);
aBSplinePCurve->SetKnots(aKnots);
ResPCurves(ii) = aBSplinePCurve;
}
ResFirsts(ii) = aFirst3d;
ResLasts(ii) = aLast3d;
} // if ranges > aMaxTol
} // for (int ii = 1; ii <= ResPCurves.Length(); ii++)
}
if (anIsSeam)
{
aBuilder.UpdateEdge(theEdge, ResPCurves(1), ResPCurves(2), TopoDS::Face(aFaceSeq(1)), aTolEdge);
}
else
{
for (int j = 1; j <= ResPCurves.Length(); j++)
{
aBuilder.UpdateEdge(theEdge, ResPCurves(j), TopoDS::Face(aFaceSeq(j)), aTolEdge);
}
}
}
//=======================================================================
// function : MergeSubSeq
// purpose : Merges a sequence of edges into one edge if possible
//=======================================================================
bool ShapeUpgrade_UnifySameDomain::MergeSubSeq(
const NCollection_Sequence<TopoDS_Shape>& theChain,
const NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>& theVFmap,
TopoDS_Edge& OutEdge)
{
ShapeAnalysis_Edge sae;
BRep_Builder B;
// union edges in chain
int j;
double fp1, lp1, fp2, lp2;
bool IsUnionOfLinesPossible = true;
bool IsUnionOfCirclesPossible = true;
occ::handle<Geom_Curve> c3d1, c3d2;
for (j = 1; j < theChain.Length(); j++)
{
TopoDS_Edge edge1 = TopoDS::Edge(theChain.Value(j));
TopoDS_Edge edge2 = TopoDS::Edge(theChain.Value(j + 1));
if (BRep_Tool::Degenerated(edge1) && BRep_Tool::Degenerated(edge2))
{
// Find the closest points in 2d
TopoDS_Edge edgeFirst = TopoDS::Edge(theChain.First());
TopoDS_Edge edgeLast = TopoDS::Edge(theChain.Last());
TopoDS_Face CommonFace;
double MinSqDist;
TopAbs_Orientation OrOfE1OnFace, OrOfE2OnFace;
int IndOnE1, IndOnE2;
gp_Pnt2d PointsOnEdge1[2], PointsOnEdge2[2];
if (!FindClosestPoints(edgeFirst,
edgeLast,
theVFmap,
CommonFace,
MinSqDist,
OrOfE1OnFace,
OrOfE2OnFace,
IndOnE1,
IndOnE2,
PointsOnEdge1,
PointsOnEdge2))
{
return false;
}
// Define indices corresponding to extremities of future edge
IndOnE1 = 1 - IndOnE1;
IndOnE2 = 1 - IndOnE2;
// Construct new degenerated edge
gp_Pnt2d StartPoint = PointsOnEdge1[IndOnE1];
gp_Pnt2d EndPoint = PointsOnEdge2[IndOnE2];
if ((OrOfE1OnFace == TopAbs_FORWARD && IndOnE1 == 1)
|| (OrOfE1OnFace == TopAbs_REVERSED && IndOnE1 == 0))
{
gp_Pnt2d Tmp = StartPoint;
StartPoint = EndPoint;
EndPoint = Tmp;
}
occ::handle<Geom2d_Line> aLine = GC_MakeLine2d(StartPoint, EndPoint);
TopoDS_Vertex aVertex = TopExp::FirstVertex(edgeFirst);
TopoDS_Vertex StartVertex = aVertex, EndVertex = aVertex;
StartVertex.Orientation(TopAbs_FORWARD);
EndVertex.Orientation(TopAbs_REVERSED);
TopoDS_Edge NewEdge;
B.MakeEdge(NewEdge);
B.UpdateEdge(NewEdge, aLine, CommonFace, Precision::Confusion());
B.Range(NewEdge, 0., StartPoint.Distance(EndPoint));
B.Add(NewEdge, StartVertex);
B.Add(NewEdge, EndVertex);
B.Degenerated(NewEdge, true);
OutEdge = NewEdge;
return true;
}
c3d1 = BRep_Tool::Curve(edge1, fp1, lp1);
c3d2 = BRep_Tool::Curve(edge2, fp2, lp2);
BRepAdaptor_Curve aBAcurve1(edge1);
BRepAdaptor_Curve aBAcurve2(edge2);
gp_Dir aDir1, aDir2;
if (c3d1.IsNull() || c3d2.IsNull())
{
return false;
}
if (c3d1->IsKind(STANDARD_TYPE(Geom_TrimmedCurve)))
{
occ::handle<Geom_TrimmedCurve> tc = occ::down_cast<Geom_TrimmedCurve>(c3d1);
c3d1 = tc->BasisCurve();
}
if (c3d2->IsKind(STANDARD_TYPE(Geom_TrimmedCurve)))
{
occ::handle<Geom_TrimmedCurve> tc = occ::down_cast<Geom_TrimmedCurve>(c3d2);
c3d2 = tc->BasisCurve();
}
if (IsLinear(aBAcurve1, aDir1) && IsLinear(aBAcurve2, aDir2))
{
occ::handle<Geom_Line> L1 = occ::down_cast<Geom_Line>(c3d1);
occ::handle<Geom_Line> L2 = occ::down_cast<Geom_Line>(c3d2);
if (!aDir1.IsParallel(aDir2, myAngTol))
{
IsUnionOfLinesPossible = false;
}
}
else
{
IsUnionOfLinesPossible = false;
}
if (c3d1->IsKind(STANDARD_TYPE(Geom_Circle)) && c3d2->IsKind(STANDARD_TYPE(Geom_Circle)))
{
occ::handle<Geom_Circle> C1 = occ::down_cast<Geom_Circle>(c3d1);
occ::handle<Geom_Circle> C2 = occ::down_cast<Geom_Circle>(c3d2);
gp_Pnt P01 = C1->Location();
gp_Pnt P02 = C2->Location();
if (P01.Distance(P02) > Precision::Confusion())
{
IsUnionOfCirclesPossible = false;
}
}
else
{
IsUnionOfCirclesPossible = false;
}
}
if (IsUnionOfLinesPossible && IsUnionOfCirclesPossible)
{
return false;
}
// union of lines is possible
if (IsUnionOfLinesPossible)
{
TopoDS_Vertex V[2];
V[0] = sae.FirstVertex(TopoDS::Edge(theChain.First()));
gp_Pnt PV1 = BRep_Tool::Pnt(V[0]);
V[1] = sae.LastVertex(TopoDS::Edge(theChain.Last()));
gp_Pnt PV2 = BRep_Tool::Pnt(V[1]);
gp_Vec Vec(PV1, PV2);
if (mySafeInputMode)
{
for (int k = 0; k < 2; k++)
{
if (!myContext->IsRecorded(V[k]))
{
TopoDS_Vertex Vcopy = TopoDS::Vertex(V[k].EmptyCopied());
myContext->Replace(V[k], Vcopy);
V[k] = Vcopy;
}
else
{
V[k] = TopoDS::Vertex(myContext->Apply(V[k]));
}
}
}
occ::handle<Geom_Line> L = new Geom_Line(gp_Ax1(PV1, Vec));
double dist = PV1.Distance(PV2);
occ::handle<Geom_TrimmedCurve> tc = new Geom_TrimmedCurve(L, 0.0, dist);
TopoDS_Edge E;
B.MakeEdge(E, tc, Precision::Confusion());
B.Add(E, V[0]);
B.Add(E, V[1]);
B.UpdateVertex(V[0], 0., E, 0.);
B.UpdateVertex(V[1], dist, E, 0.);
UnionPCurves(theChain, E);
OutEdge = E;
return true;
}
if (IsUnionOfCirclesPossible)
{
double f, l;
TopoDS_Edge FE = TopoDS::Edge(theChain.First());
occ::handle<Geom_Curve> c3d = BRep_Tool::Curve(FE, f, l);
if (c3d->IsKind(STANDARD_TYPE(Geom_TrimmedCurve)))
{
occ::handle<Geom_TrimmedCurve> tc = occ::down_cast<Geom_TrimmedCurve>(c3d);
c3d = tc->BasisCurve();
}
occ::handle<Geom_Circle> Cir = occ::down_cast<Geom_Circle>(c3d);
TopoDS_Vertex V[2];
V[0] = sae.FirstVertex(FE);
V[1] = sae.LastVertex(TopoDS::Edge(theChain.Last()));
bool isClosed = V[0].IsSame(V[1]);
if (!isClosed)
{
// additionally check the points for equality to make a final decision about closedness of the
// result curve
gp_Pnt aP0 = BRep_Tool::Pnt(V[0]);
gp_Pnt aP1 = BRep_Tool::Pnt(V[1]);
double aTol = std::max(BRep_Tool::Tolerance(V[0]), BRep_Tool::Tolerance(V[1]));
if (aP0.SquareDistance(aP1) < aTol * aTol)
{
isClosed = true;
V[1] = V[0];
V[1].Reverse();
}
}
TopoDS_Edge E;
if (isClosed)
{
// closed chain
BRepAdaptor_Curve adef(FE);
occ::handle<Geom_Circle> Cir1;
double FP, LP;
if (FE.Orientation() == TopAbs_FORWARD)
{
FP = adef.FirstParameter();
LP = adef.LastParameter();
}
else
{
FP = adef.LastParameter();
LP = adef.FirstParameter();
}
if (std::abs(FP) < Precision::PConfusion())
{
B.MakeEdge(E, Cir, Precision::Confusion());
B.Add(E, V[0]);
B.Add(E, V[1]);
E.Orientation(FE.Orientation());
}
else
{
GC_MakeCircle MC1(adef.Value(FP), adef.Value((FP + LP) * 0.5), adef.Value(LP));
if (MC1.IsDone())
{
Cir1 = MC1.Value();
}
else
{
return false;
}
B.MakeEdge(E, Cir1, Precision::Confusion());
B.Add(E, V[0]);
B.Add(E, V[1]);
}
}
else // open chain
{
double ParamFirst = BRep_Tool::Parameter(V[0], FE);
TopoDS_Vertex VertexLastOnFE = sae.LastVertex(FE);
double ParamLast = BRep_Tool::Parameter(VertexLastOnFE, FE);
if (mySafeInputMode)
{
for (int k = 0; k < 2; k++)
{
if (!myContext->IsRecorded(V[k]))
{
TopoDS_Vertex Vcopy = TopoDS::Vertex(V[k].EmptyCopied());
myContext->Replace(V[k], Vcopy);
V[k] = Vcopy;
}
else
{
V[k] = TopoDS::Vertex(myContext->Apply(V[k]));
}
}
}
gp_Pnt PointFirst = BRep_Tool::Pnt(V[0]);
while (std::abs(ParamLast - ParamFirst) > 7 * M_PI / 8)
{
ParamLast = (ParamFirst + ParamLast) / 2;
}
BRepAdaptor_Curve BAcurveFE(FE);
gp_Pnt PointLast = BAcurveFE.Value(ParamLast);
gp_Pnt Origin = Cir->Circ().Location();
gp_Dir Dir1 = gp_Vec(Origin, PointFirst);
gp_Dir Dir2 = gp_Vec(Origin, PointLast);
gp_Dir Vdir = Dir1 ^ Dir2;
gp_Ax2 anAx2(Origin, Vdir, Dir1);
occ::handle<Geom_Circle> aNewCircle = new Geom_Circle(anAx2, Cir->Radius());
gp_Pnt PointLastInChain = BRep_Tool::Pnt(V[1]);
gp_Dir DirLastInChain = gp_Vec(Origin, PointLastInChain);
double lpar = Dir1.AngleWithRef(DirLastInChain, Vdir);
if (lpar < 0.)
{
lpar += 2 * M_PI;
}
occ::handle<Geom_TrimmedCurve> tc = new Geom_TrimmedCurve(aNewCircle, 0., lpar);
B.MakeEdge(E, tc, Precision::Confusion());
B.Add(E, V[0]);
B.Add(E, V[1]);
B.UpdateVertex(V[0], 0., E, 0.);
B.UpdateVertex(V[1], lpar, E, 0.);
}
UnionPCurves(theChain, E);
OutEdge = E;
return true;
}
if (theChain.Length() > 1 && myConcatBSplines)
{
// second step: union edges with various curves
// skl for bug 0020052 from Mantis: perform such unions
// only if curves are bspline or bezier
TopoDS_Vertex VF = sae.FirstVertex(TopoDS::Edge(theChain.First()));
TopoDS_Vertex VL = sae.LastVertex(TopoDS::Edge(theChain.Last()));
bool NeedUnion = true;
for (j = 1; j <= theChain.Length(); j++)
{
TopoDS_Edge edge = TopoDS::Edge(theChain.Value(j));
TopLoc_Location Loc;
occ::handle<Geom_Curve> c3d = BRep_Tool::Curve(edge, Loc, fp1, lp1);
if (c3d.IsNull())
{
continue;
}
if (c3d->IsKind(STANDARD_TYPE(Geom_TrimmedCurve)))
{
occ::handle<Geom_TrimmedCurve> tc = occ::down_cast<Geom_TrimmedCurve>(c3d);
c3d = tc->BasisCurve();
}
if ((c3d->IsKind(STANDARD_TYPE(Geom_BSplineCurve))
|| c3d->IsKind(STANDARD_TYPE(Geom_BezierCurve))))
{
continue;
}
NeedUnion = false;
break;
}
if (NeedUnion)
{
OutEdge = GlueEdgesWith3DCurves(theChain, VF, VL);
return true;
}
}
return false;
}
//=======================================================================
// function : IsMergingPossible
// purpose : Checks if merging of two edges is possible
//=======================================================================
static bool IsMergingPossible(
const TopoDS_Edge& edge1,
const TopoDS_Edge& edge2,
double theAngTol,
double theLinTol,
const NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& AvoidEdgeVrt,
const bool theLineDirectionOk,
const gp_Pnt& theFirstPoint,
const gp_Vec& theDirectionVec,
const NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>& theVFmap)
{
bool IsDegE1 = BRep_Tool::Degenerated(edge1);
bool IsDegE2 = BRep_Tool::Degenerated(edge2);
if (IsDegE1 && IsDegE2)
{
// Find connstion point in 2d
TopoDS_Face CommonFace;
double MinSqDist;
TopAbs_Orientation OrOfE1OnFace, OrOfE2OnFace;
int IndOnE1, IndOnE2;
gp_Pnt2d PointsOnEdge1[2], PointsOnEdge2[2];
if (!FindClosestPoints(edge1,
edge2,
theVFmap,
CommonFace,
MinSqDist,
OrOfE1OnFace,
OrOfE2OnFace,
IndOnE1,
IndOnE2,
PointsOnEdge1,
PointsOnEdge2))
{
return false;
}
if (MinSqDist <= Precision::SquareConfusion())
{
return true;
}
return false;
}
else if (IsDegE1 || IsDegE2)
{
return false;
}
TopoDS_Vertex CV = TopExp::LastVertex(edge1, true);
if (CV.IsNull() || AvoidEdgeVrt.Contains(CV))
{
return false;
}
BRepAdaptor_Curve ade1(edge1);
BRepAdaptor_Curve ade2(edge2);
GeomAbs_CurveType t1 = ade1.GetType();
GeomAbs_CurveType t2 = ade2.GetType();
if (t1 == GeomAbs_Circle && t2 == GeomAbs_Circle)
{
if (ade1.Circle().Location().Distance(ade2.Circle().Location()) > Precision::Confusion())
{
return false;
}
}
gp_Dir aDir1, aDir2;
if (!(IsLinear(ade1, aDir1) && IsLinear(ade2, aDir2))
&& ((t1 != GeomAbs_BezierCurve && t1 != GeomAbs_BSplineCurve)
|| (t2 != GeomAbs_BezierCurve && t2 != GeomAbs_BSplineCurve))
&& t1 != t2)
{
return false;
}
gp_Vec Diff1, Diff2;
gp_Pnt P1, P2;
if (edge1.Orientation() == TopAbs_FORWARD)
{
ade1.D1(ade1.LastParameter(), P1, Diff1);
}
else
{
ade1.D1(ade1.FirstParameter(), P1, Diff1);
Diff1 = -Diff1;
}
if (edge2.Orientation() == TopAbs_FORWARD)
{
ade2.D1(ade2.FirstParameter(), P2, Diff2);
}
else
{
ade2.D1(ade2.LastParameter(), P2, Diff2);
Diff2 = -Diff2;
}
if (Diff1.Angle(Diff2) > theAngTol)
{
return false;
}
if (theLineDirectionOk && t2 == GeomAbs_Line)
{
// Check that the accumulated deflection does not exceed the linear tolerance
double aLast =
(edge2.Orientation() == TopAbs_FORWARD) ? ade2.LastParameter() : ade2.FirstParameter();
gp_Vec aCurV(theFirstPoint, ade2.Value(aLast));
double aDD = theDirectionVec.CrossSquareMagnitude(aCurV);
if (aDD > theLinTol * theLinTol)
{
return false;
}
// Check that the accumulated angle does not exceed the angular tolerance.
// For symmetry, check the angle between vectors of:
// - first edge and resulting curve, and
// - the last edge and resulting curve.
if (theDirectionVec.Angle(aCurV) > theAngTol || Diff2.Angle(aCurV) > theAngTol)
{
return false;
}
}
return true;
}
//=================================================================================================
static bool GetLineEdgePoints(const TopoDS_Edge& theInpEdge,
gp_Pnt& theFirstPoint,
gp_Vec& theDirectionVec)
{
double f, l;
occ::handle<Geom_Curve> aCur = BRep_Tool::Curve(theInpEdge, f, l);
if (aCur.IsNull())
{
return false;
}
occ::handle<Geom_TrimmedCurve> aTC = occ::down_cast<Geom_TrimmedCurve>(aCur);
if (!aTC.IsNull())
{
aCur = aTC->BasisCurve();
}
if (aCur->DynamicType() != STANDARD_TYPE(Geom_Line))
{
return false;
}
if (theInpEdge.Orientation() == TopAbs_REVERSED)
{
double tmp = f;
f = l;
l = tmp;
}
theFirstPoint = aCur->Value(f);
gp_Pnt aLP = aCur->Value(l);
theDirectionVec = aLP.XYZ().Subtracted(theFirstPoint.XYZ());
theDirectionVec.Normalize();
return true;
}
struct ShapeUpgrade_UnifySameDomain::SubSequenceOfEdges
{
NCollection_Sequence<TopoDS_Shape> SeqsEdges;
TopoDS_Edge UnionEdges;
};
//=================================================================================================
void ShapeUpgrade_UnifySameDomain::generateSubSeq(
const NCollection_Sequence<TopoDS_Shape>& anInpEdgeSeq,
NCollection_Sequence<SubSequenceOfEdges>& SeqOfSubSeqOfEdges,
bool IsClosed,
double theAngTol,
double theLinTol,
const NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& AvoidEdgeVrt,
const NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>& theVFmap)
{
bool isOk = false;
TopoDS_Edge edge1, edge2;
SubSequenceOfEdges SubSeq;
TopoDS_Edge RefEdge = TopoDS::Edge(anInpEdgeSeq(1));
SubSeq.SeqsEdges.Append(RefEdge);
SeqOfSubSeqOfEdges.Append(SubSeq);
gp_Pnt aFirstPoint;
gp_Vec aDirectionVec;
bool isLineDirectionOk = GetLineEdgePoints(RefEdge, aFirstPoint, aDirectionVec);
for (int i = 1; i < anInpEdgeSeq.Length(); i++)
{
edge1 = TopoDS::Edge(anInpEdgeSeq(i));
edge2 = TopoDS::Edge(anInpEdgeSeq(i + 1));
isOk = IsMergingPossible(edge1,
edge2,
theAngTol,
theLinTol,
AvoidEdgeVrt,
isLineDirectionOk,
aFirstPoint,
aDirectionVec,
theVFmap);
if (!isOk)
{
SubSequenceOfEdges aSubSeq;
aSubSeq.SeqsEdges.Append(edge2);
SeqOfSubSeqOfEdges.Append(aSubSeq);
isLineDirectionOk = GetLineEdgePoints(edge2, aFirstPoint, aDirectionVec);
}
else
{
SeqOfSubSeqOfEdges.ChangeLast().SeqsEdges.Append(edge2);
}
}
/// check first and last chain segments
if (IsClosed && SeqOfSubSeqOfEdges.Length() > 1)
{
edge1 = TopoDS::Edge(anInpEdgeSeq.Last());
edge2 = TopoDS::Edge(anInpEdgeSeq.First());
if (IsMergingPossible(edge1,
edge2,
theAngTol,
theLinTol,
AvoidEdgeVrt,
false,
aFirstPoint,
aDirectionVec,
theVFmap))
{
SeqOfSubSeqOfEdges.ChangeLast().SeqsEdges.Append(SeqOfSubSeqOfEdges.ChangeFirst().SeqsEdges);
SeqOfSubSeqOfEdges.Remove(1);
}
}
}
//=================================================================================================
bool ShapeUpgrade_UnifySameDomain::MergeEdges(
NCollection_Sequence<TopoDS_Shape>& SeqEdges,
const NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>& theVFmap,
NCollection_Sequence<SubSequenceOfEdges>& SeqOfSubSeqOfEdges,
const NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& NonMergVrt)
{
NCollection_IndexedDataMap<TopoDS_Shape, NCollection_List<TopoDS_Shape>, TopTools_ShapeMapHasher>
aMapVE;
int j;
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> VerticesToAvoid;
const int aNbE = SeqEdges.Length();
for (j = 1; j <= aNbE; j++)
{
TopoDS_Edge anEdge = TopoDS::Edge(SeqEdges(j));
// fill in the map V-E
for (TopoDS_Iterator it(anEdge.Oriented(TopAbs_FORWARD)); it.More(); it.Next())
{
const TopoDS_Shape& aV = it.Value();
if (aV.Orientation() == TopAbs_FORWARD || aV.Orientation() == TopAbs_REVERSED)
{
if (!aMapVE.Contains(aV))
{
aMapVE.Add(aV, NCollection_List<TopoDS_Shape>());
}
aMapVE.ChangeFromKey(aV).Append(anEdge);
}
}
}
NCollection_MapAlgo::Unite(VerticesToAvoid, NonMergVrt);
// do loop while there are unused edges
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> aUsedEdges;
for (int iE = 1; iE <= aNbE; ++iE)
{
TopoDS_Edge edge = TopoDS::Edge(SeqEdges(iE));
if (!aUsedEdges.Add(edge))
{
continue;
}
// make chain for unite
NCollection_Sequence<TopoDS_Shape> aChain;
aChain.Append(edge);
TopoDS_Vertex V[2];
TopExp::Vertices(edge, V[0], V[1], true);
// connect more edges to the chain in both directions
for (j = 0; j < 2; j++)
{
bool isAdded = true;
while (isAdded)
{
isAdded = false;
if (V[j].IsNull())
{
break;
}
const NCollection_List<TopoDS_Shape>& aLE = aMapVE.FindFromKey(V[j]);
for (NCollection_List<TopoDS_Shape>::Iterator itL(aLE); itL.More(); itL.Next())
{
edge = TopoDS::Edge(itL.Value());
if (!aUsedEdges.Contains(edge))
{
TopoDS_Vertex V2[2];
TopExp::Vertices(edge, V2[0], V2[1], true);
// the neighboring edge must have V[j] reversed and located on the opposite end
if (V2[1 - j].IsEqual(V[j].Reversed()))
{
if (j == 0)
{
aChain.Prepend(edge);
}
else
{
aChain.Append(edge);
}
aUsedEdges.Add(edge);
V[j] = V2[j];
isAdded = true;
break;
}
}
}
}
}
if (aChain.Length() < 2)
{
continue;
}
bool IsClosed = false;
if (V[0].IsSame(V[1]))
{
IsClosed = true;
}
// split chain by vertices at which merging is not possible
NCollection_Sequence<SubSequenceOfEdges> aOneSeq;
generateSubSeq(aChain, aOneSeq, IsClosed, myAngTol, myLinTol, VerticesToAvoid, theVFmap);
// put sub-chains in the result
SeqOfSubSeqOfEdges.Append(aOneSeq);
}
for (int i = 1; i <= SeqOfSubSeqOfEdges.Length(); i++)
{
TopoDS_Edge UE;
if (SeqOfSubSeqOfEdges(i).SeqsEdges.Length() < 2)
{
continue;
}
if (MergeSubSeq(SeqOfSubSeqOfEdges(i).SeqsEdges, theVFmap, UE))
{
SeqOfSubSeqOfEdges(i).UnionEdges = UE;
}
}
return true;
}
//=======================================================================
// function : MergeSeq
// purpose : Tries to unify the sequence of edges with the set of
// another edges which lies on the same geometry
//=======================================================================
bool ShapeUpgrade_UnifySameDomain::MergeSeq(
NCollection_Sequence<TopoDS_Shape>& SeqEdges,
const NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>& theVFmap,
const NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& nonMergVert)
{
NCollection_Sequence<SubSequenceOfEdges> SeqOfSubsSeqOfEdges;
if (MergeEdges(SeqEdges, theVFmap, SeqOfSubsSeqOfEdges, nonMergVert))
{
for (int i = 1; i <= SeqOfSubsSeqOfEdges.Length(); i++)
{
if (SeqOfSubsSeqOfEdges(i).UnionEdges.IsNull())
{
continue;
}
myContext->Merge(SeqOfSubsSeqOfEdges(i).SeqsEdges, SeqOfSubsSeqOfEdges(i).UnionEdges);
}
return true;
}
return false;
}
//=======================================================================
// function : CheckSharedVertices
// purpose : Checks the sequence of edges on the presence of shared vertex
//=======================================================================
static void CheckSharedVertices(
const NCollection_Sequence<TopoDS_Shape>& theSeqEdges,
const NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>& theMapEdgesVertex,
const NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& theMapKeepShape,
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& theShareVertMap)
{
ShapeAnalysis_Edge sae;
NCollection_Sequence<TopoDS_Shape> SeqVertexes;
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> MapVertexes;
for (int k = 1; k <= theSeqEdges.Length(); k++)
{
TopoDS_Vertex aV1 = sae.FirstVertex(TopoDS::Edge(theSeqEdges(k)));
TopoDS_Vertex aV2 = sae.LastVertex(TopoDS::Edge(theSeqEdges(k)));
if (!MapVertexes.Add(aV1))
{
SeqVertexes.Append(aV1);
}
if (!MapVertexes.Add(aV2))
{
SeqVertexes.Append(aV2);
}
}
for (int k = 1; k <= SeqVertexes.Length() /* && !IsSharedVertexPresent*/; k++)
{
const NCollection_List<TopoDS_Shape>& ListEdgesV1 =
theMapEdgesVertex.FindFromKey(SeqVertexes(k));
if (ListEdgesV1.Extent() > 2 || theMapKeepShape.Contains(SeqVertexes(k)))
{
theShareVertMap.Add(SeqVertexes(k));
}
}
// return theShareVertMap.IsEmpty() ? false : true;
}
//=================================================================================================
ShapeUpgrade_UnifySameDomain::ShapeUpgrade_UnifySameDomain()
: myLinTol(Precision::Confusion()),
myAngTol(Precision::Angular()),
myUnifyFaces(true),
myUnifyEdges(true),
myConcatBSplines(false),
myAllowInternal(false),
mySafeInputMode(true),
myHistory(new BRepTools_History)
{
myContext = new ShapeBuild_ReShape;
}
//=================================================================================================
ShapeUpgrade_UnifySameDomain::ShapeUpgrade_UnifySameDomain(const TopoDS_Shape& aShape,
const bool UnifyEdges,
const bool UnifyFaces,
const bool ConcatBSplines)
: myInitShape(aShape),
myLinTol(Precision::Confusion()),
myAngTol(Precision::Angular()),
myUnifyFaces(UnifyFaces),
myUnifyEdges(UnifyEdges),
myConcatBSplines(ConcatBSplines),
myAllowInternal(false),
mySafeInputMode(true),
myShape(aShape),
myHistory(new BRepTools_History)
{
myContext = new ShapeBuild_ReShape;
}
//=================================================================================================
void ShapeUpgrade_UnifySameDomain::Initialize(const TopoDS_Shape& aShape,
const bool UnifyEdges,
const bool UnifyFaces,
const bool ConcatBSplines)
{
myInitShape = aShape;
myShape = aShape;
myUnifyEdges = UnifyEdges;
myUnifyFaces = UnifyFaces;
myConcatBSplines = ConcatBSplines;
myContext->Clear();
myKeepShapes.Clear();
myFacePlaneMap.Clear();
myEFmap.Clear();
myFaceNewFace.Clear();
myHistory->Clear();
}
//=================================================================================================
void ShapeUpgrade_UnifySameDomain::AllowInternalEdges(const bool theValue)
{
myAllowInternal = theValue;
}
//=================================================================================================
void ShapeUpgrade_UnifySameDomain::SetSafeInputMode(bool theValue)
{
mySafeInputMode = theValue;
}
//=================================================================================================
void ShapeUpgrade_UnifySameDomain::KeepShape(const TopoDS_Shape& theShape)
{
if (theShape.ShapeType() == TopAbs_EDGE || theShape.ShapeType() == TopAbs_VERTEX)
{
myKeepShapes.Add(theShape);
}
}
//=================================================================================================
void ShapeUpgrade_UnifySameDomain::KeepShapes(
const NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& theShapes)
{
for (NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>::Iterator it(theShapes); it.More();
it.Next())
{
if (it.Value().ShapeType() == TopAbs_EDGE || it.Value().ShapeType() == TopAbs_VERTEX)
{
myKeepShapes.Add(it.Value());
}
}
}
//=================================================================================================
void ShapeUpgrade_UnifySameDomain::UnifyFaces()
{
// creating map of edge faces for the whole shape
NCollection_IndexedDataMap<TopoDS_Shape, NCollection_List<TopoDS_Shape>, TopTools_ShapeMapHasher>
aGMapEdgeFaces;
NCollection_IndexedMap<TopoDS_Shape, TopTools_ShapeMapHasher> aFaceMap;
TopExp::MapShapes(myShape, TopAbs_FACE, aFaceMap);
for (int i = 1; i <= aFaceMap.Extent(); i++)
{
TopExp::MapShapesAndAncestors(aFaceMap(i), TopAbs_EDGE, TopAbs_FACE, aGMapEdgeFaces);
}
// creating map of face shells for the whole shape to avoid
// unification of faces belonging to the different shells
DataMapOfShapeMapOfShape aGMapFaceShells;
for (TopExp_Explorer anExp(myShape, TopAbs_SHELL); anExp.More(); anExp.Next())
{
const TopoDS_Shape& aShell = anExp.Current();
for (TopoDS_Iterator anItF(aShell); anItF.More(); anItF.Next())
{
const TopoDS_Shape& aF = anItF.Value();
if (NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>* pShells =
aGMapFaceShells.ChangeSeek(aF))
{
pShells->Add(aShell);
}
else
{
(aGMapFaceShells.Bound(aF, NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>()))
->Add(aShell);
}
}
}
// creating map of free boundaries
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> aFreeBoundMap;
// look at only shells not belonging to solids
TopExp_Explorer anExplo(myShape, TopAbs_SHELL, TopAbs_SOLID);
for (; anExplo.More(); anExplo.Next())
{
const TopoDS_Shape& aShell = anExplo.Current();
NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>
aEFmap;
TopExp::MapShapesAndAncestors(aShell, TopAbs_EDGE, TopAbs_FACE, aEFmap);
for (int ii = 1; ii <= aEFmap.Extent(); ii++)
{
const TopoDS_Edge& anEdge = TopoDS::Edge(aEFmap.FindKey(ii));
const NCollection_List<TopoDS_Shape>& aFaceList = aEFmap(ii);
if (!BRep_Tool::Degenerated(anEdge) && aFaceList.Extent() == 1)
{
aFreeBoundMap.Add(anEdge);
}
}
}
// unify faces in each shell separately
TopExp_Explorer exps;
for (exps.Init(myShape, TopAbs_SHELL); exps.More(); exps.Next())
{
IntUnifyFaces(exps.Current(), aGMapEdgeFaces, aGMapFaceShells, aFreeBoundMap);
}
// gather all faces out of shells in one compound and unify them at once
BRep_Builder aBB;
TopoDS_Compound aCmp;
aBB.MakeCompound(aCmp);
int nbf = 0;
for (exps.Init(myShape, TopAbs_FACE, TopAbs_SHELL); exps.More(); exps.Next(), nbf++)
{
aBB.Add(aCmp, exps.Current());
}
if (nbf > 0)
{
// No connection to shells, thus no need to pass the face-shell map
IntUnifyFaces(aCmp, aGMapEdgeFaces, DataMapOfShapeMapOfShape(), aFreeBoundMap);
}
myShape = myContext->Apply(myShape);
}
//=================================================================================================
static void SetFixWireModes(ShapeFix_Face& theSff)
{
occ::handle<ShapeFix_Wire> aFixWire = theSff.FixWireTool();
aFixWire->FixSelfIntersectionMode() = 0;
aFixWire->FixNonAdjacentIntersectingEdgesMode() = 0;
aFixWire->FixLackingMode() = 0;
aFixWire->FixNotchedEdgesMode() = 0;
aFixWire->ModifyTopologyMode() = false;
aFixWire->ModifyRemoveLoopMode() = 0;
aFixWire->FixGapsByRangesMode() = false;
aFixWire->FixSmallMode() = 0;
}
//=======================================================================
// function : isSameSets
// purpose : Compares two sets of shapes. Returns true if they are the same,
// false otherwise.
//=======================================================================
template <class Container>
static bool isSameSets(const Container* theFShells1, const Container* theFShells2)
{
// If both are null - no problem
if (theFShells1 == nullptr && theFShells2 == nullptr)
{
return true;
}
// If only one is null - not the same
if (theFShells1 == nullptr || theFShells2 == nullptr)
{
return false;
}
// Both not null
if (theFShells1->Extent() != theFShells2->Extent())
{
return false;
}
// number of shells in each set should be very small in normal cases - max 2.
// thus just check if all objects of one are contained in the other and vice versa.
for (typename Container::Iterator it1(*theFShells1), it2(*theFShells2); it1.More() && it2.More();
it1.Next(), it2.Next())
{
if (!theFShells1->Contains(it2.Value()) || !theFShells2->Contains(it1.Value()))
{
return false;
}
}
return true;
}
//=================================================================================================
void ShapeUpgrade_UnifySameDomain::IntUnifyFaces(
const TopoDS_Shape& theInpShape,
const NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>& theGMapEdgeFaces,
const DataMapOfShapeMapOfShape& theGMapFaceShells,
const NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>& theFreeBoundMap)
{
// creating map of edge faces for the shape
NCollection_IndexedDataMap<TopoDS_Shape, NCollection_List<TopoDS_Shape>, TopTools_ShapeMapHasher>
aMapEdgeFaces;
TopExp::MapShapesAndAncestors(theInpShape, TopAbs_EDGE, TopAbs_FACE, aMapEdgeFaces);
// map of processed shapes
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> aProcessed;
// processing each face
TopExp_Explorer exp;
for (exp.Init(theInpShape, TopAbs_FACE); exp.More(); exp.Next())
{
const TopoDS_Face aFace = TopoDS::Face(exp.Current());
if (aProcessed.Contains(aFace))
{
continue;
}
const occ::handle<Geom_Surface> aBaseSurface = ClearRts(BRep_Tool::Surface(aFace));
// Bug 33894: Prevent crash when face has no surface
if (aBaseSurface.IsNull())
{
continue;
}
// Boundary edges for the new face
NCollection_Sequence<TopoDS_Shape> edges;
NCollection_Sequence<TopoDS_Shape> RemovedEdges;
int dummy;
AddOrdinaryEdges(edges, aFace, dummy, RemovedEdges);
// Faces to get unified with the current faces
NCollection_Sequence<TopoDS_Shape> faces;
// Add the current face for unification
faces.Append(aFace);
// surface and location to construct result
TopLoc_Location aBaseLocation;
TopAbs_Orientation RefFaceOrientation = aFace.Orientation();
// Take original surface
TopoDS_Face RefFace;
BRep_Builder BB;
BB.MakeFace(RefFace, aBaseSurface, aBaseLocation, 0.);
RefFace.Orientation(RefFaceOrientation);
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>
MapEdgesWithTemporaryPCurves; // map of edges not lying on RefFace
// these edges may be updated by temporary pcurves
double Uperiod = (aBaseSurface->IsUPeriodic()) ? aBaseSurface->UPeriod() : 0.;
double Vperiod = (aBaseSurface->IsVPeriodic()) ? aBaseSurface->VPeriod() : 0.;
// Get shells connected to the face (in normal cases should not be more than 2)
const NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>* pFShells1 =
theGMapFaceShells.Seek(aFace);
// find adjacent faces to union
int i;
for (i = 1; i <= edges.Length(); i++)
{
TopoDS_Edge edge = TopoDS::Edge(edges(i));
if (BRep_Tool::Degenerated(edge))
{
continue;
}
// get connectivity of the edge in the global shape
const NCollection_List<TopoDS_Shape>& aGList = theGMapEdgeFaces.FindFromKey(edge);
if (!myAllowInternal
&& (aGList.Extent() != 2 || myKeepShapes.Contains(edge)
|| theFreeBoundMap.Contains(edge)))
{
// non manifold case is not processed unless myAllowInternal
continue;
}
//
// Get the faces connected through the edge in the current shape
const NCollection_List<TopoDS_Shape>& aList = aMapEdgeFaces.FindFromKey(edge);
if (aList.Extent() < 2)
{
continue;
}
// for a planar face create and store pcurve of edge on face
// to speed up all operations
if (!mySafeInputMode && aBaseSurface->IsKind(STANDARD_TYPE(Geom_Plane)))
{
BRepLib::BuildPCurveForEdgeOnPlane(edge, aFace);
}
// get normal of the face to compare it with normals of other faces
gp_Dir aDN1;
//
// take intermediate point on edge to compute the normal
double f, l;
BRep_Tool::Range(edge, f, l);
double aTMid = (f + l) * .5;
//
bool bCheckNormals = GetNormalToSurface(aFace, edge, aTMid, aDN1);
//
// Process the faces
NCollection_List<TopoDS_Shape>::Iterator anIter(aList);
for (; anIter.More(); anIter.Next())
{
TopoDS_Face aCheckedFace = TopoDS::Face(anIter.Value());
if (aCheckedFace.IsSame(aFace))
{
continue;
}
if (aProcessed.Contains(aCheckedFace))
{
continue;
}
// Get shells connected to the checked face
const NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>* pFShells2 =
theGMapFaceShells.Seek(aCheckedFace);
// Faces can be unified only if the shells of faces connected to
// these faces are the same. Otherwise, topology would be broken.
if (!isSameSets(pFShells1, pFShells2))
{
continue;
}
if (bCheckNormals)
{
// get normal of checked face using the same parameter on edge
gp_Dir aDN2;
if (GetNormalToSurface(aCheckedFace, edge, aTMid, aDN2))
{
// and check if the adjacent faces are having approximately same normals
double anAngle = aDN1.Angle(aDN2);
if (anAngle > myAngTol)
{
continue;
}
}
}
//
if (IsSameDomain(aFace, aCheckedFace, myLinTol, myAngTol, myFacePlaneMap))
{
if (AddOrdinaryEdges(edges, aCheckedFace, dummy, RemovedEdges))
{
// sequence edges is modified
i = dummy;
}
faces.Append(aCheckedFace);
aProcessed.Add(aCheckedFace);
break;
}
}
}
if (faces.Length() > 1)
{
if (myFacePlaneMap.IsBound(faces(1)))
{
const occ::handle<Geom_Plane>& aPlane = myFacePlaneMap(faces(1));
TopLoc_Location aLoc;
BB.UpdateFace(RefFace, aPlane, aLoc, Precision::Confusion());
}
// Add correct pcurves for the reference surface to the edges of other faces
TopoDS_Face F_RefFace = RefFace;
F_RefFace.Orientation(TopAbs_FORWARD);
AddPCurves(faces, F_RefFace, MapEdgesWithTemporaryPCurves);
// fill in the connectivity map for selected faces
NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>
aMapEF;
for (i = 1; i <= faces.Length(); i++)
{
TopExp::MapShapesAndAncestors(faces(i), TopAbs_EDGE, TopAbs_FACE, aMapEF);
}
// Collect keep edges and multi-connected edges, i.e. edges that are internal to
// the set of selected faces and have connections to other faces.
NCollection_List<TopoDS_Shape> aKeepEdges;
for (i = 1; i <= aMapEF.Extent(); i++)
{
const NCollection_List<TopoDS_Shape>& aLF = aMapEF(i);
if (aLF.Extent() == 2)
{
const TopoDS_Shape& aE = aMapEF.FindKey(i);
const NCollection_List<TopoDS_Shape>& aGLF = theGMapEdgeFaces.FindFromKey(aE);
if (aGLF.Extent() > 2 || myKeepShapes.Contains(aE) || theFreeBoundMap.Contains(aE))
{
aKeepEdges.Append(aE);
}
}
}
if (!aKeepEdges.IsEmpty())
{
if (!myAllowInternal)
{
// Remove from the selection the faces which have no other connect edges
// and contain multi-connected edges and/or keep edges.
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> anAvoidFaces;
NCollection_List<TopoDS_Shape>::Iterator it(aKeepEdges);
for (; it.More(); it.Next())
{
const TopoDS_Shape& aE = it.Value();
const NCollection_List<TopoDS_Shape>& aLF = aMapEF.FindFromKey(aE);
anAvoidFaces.Add(aLF.First());
anAvoidFaces.Add(aLF.Last());
}
for (i = 1; i <= faces.Length(); i++)
{
if (anAvoidFaces.Contains(faces(i)))
{
// update the boundaries of merged area, for that
// remove from 'edges' the edges of this face and add to 'edges'
// the edges of this face that were not present in 'edges' before
bool hasConnectAnotherFaces = false;
TopExp_Explorer ex(faces(i), TopAbs_EDGE);
for (; ex.More() && !hasConnectAnotherFaces; ex.Next())
{
const TopoDS_Shape& aE = ex.Current();
const NCollection_List<TopoDS_Shape>& aLF = aMapEF.FindFromKey(aE);
if (aLF.Extent() > 1)
{
for (it.Init(aLF); it.More() && !hasConnectAnotherFaces; it.Next())
{
if (!anAvoidFaces.Contains(it.Value()))
{
hasConnectAnotherFaces = true;
}
}
}
}
if (!hasConnectAnotherFaces)
{
AddOrdinaryEdges(edges, faces(i), dummy, RemovedEdges);
faces.Remove(i);
i--;
}
}
}
// check if the faces with keep edges contained in
// already updated the boundaries of merged area
if (!faces.IsEmpty())
{
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> aMapFaces;
for (i = 1; i <= faces.Length(); i++)
{
aMapFaces.Add(faces(i));
}
for (it.Init(aKeepEdges); it.More(); it.Next())
{
const TopoDS_Shape& aE = it.Value();
const NCollection_List<TopoDS_Shape>& aLF = aMapEF.FindFromKey(aE);
if (aLF.Extent() < 2)
{
continue;
}
if (aMapFaces.Contains(aLF.First()) && aMapFaces.Contains(aLF.Last()))
{
for (i = 1; i <= faces.Length(); i++)
{
if (faces(i).IsEqual(aLF.First()) || faces(i).IsEqual(aLF.Last()))
{
AddOrdinaryEdges(edges, faces(i), dummy, RemovedEdges);
faces.Remove(i);
i--;
}
}
}
}
}
} // if (!myAllowInternal)
else
{ // internal edges are allowed
// add multi-connected and keep edges as internal in new face
NCollection_List<TopoDS_Shape>::Iterator it(aKeepEdges);
for (; it.More(); it.Next())
{
const TopoDS_Shape& aE = it.Value();
edges.Append(aE.Oriented(TopAbs_INTERNAL));
}
}
} // if (!aKeepEdges.IsEmpty())
} // if (faces.Length() > 1)
NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>
aMapEF;
for (i = 1; i <= faces.Length(); i++)
{
TopExp::MapShapesAndUniqueAncestors(faces(i), TopAbs_EDGE, TopAbs_FACE, aMapEF);
}
// Correct orientation of edges
for (int ii = 1; ii <= edges.Length(); ii++)
{
const TopoDS_Shape& anEdge = edges(ii);
int indE = aMapEF.FindIndex(anEdge);
const NCollection_List<TopoDS_Shape>& aLF = aMapEF(indE);
if (myAllowInternal && myKeepShapes.Contains(anEdge) && aLF.Extent() == 2)
{
edges(ii).Orientation(TopAbs_INTERNAL);
}
if (anEdge.Orientation() != TopAbs_INTERNAL)
{
edges(ii) = aMapEF.FindKey(indE);
}
}
// Exclude internal edges
NCollection_IndexedMap<TopoDS_Shape, TopTools_ShapeMapHasher> InternalEdges;
int ind_e = 1;
while (ind_e <= edges.Length())
{
const TopoDS_Shape& anEdge = edges(ind_e);
if (anEdge.Orientation() == TopAbs_INTERNAL)
{
InternalEdges.Add(anEdge);
edges.Remove(ind_e);
}
else
{
ind_e++;
}
}
if (RefFaceOrientation == TopAbs_REVERSED)
{
for (int ii = 1; ii <= edges.Length(); ii++)
{
edges(ii).Reverse();
}
}
TopoDS_Face F_RefFace = RefFace;
F_RefFace.Orientation(TopAbs_FORWARD);
// all faces collected in the sequence. Perform union of faces
if (faces.Length() > 1)
{
double CoordTol = Precision::Confusion();
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> edgesMap;
CoordTol = ComputeMinEdgeSize(edges, F_RefFace, edgesMap);
CoordTol /= 10.;
CoordTol = std::max(CoordTol, Precision::Confusion());
NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>
VEmap;
for (int ind = 1; ind <= edges.Length(); ind++)
{
TopExp::MapShapesAndUniqueAncestors(edges(ind), TopAbs_VERTEX, TopAbs_EDGE, VEmap);
}
// Try to find seam edge and an edge that is not seam but has 2 pcurves on the surface
bool SeamFound = false, UseamFound = false, VseamFound = false;
TopoDS_Edge EdgeWith2pcurves;
for (int ii = 1; ii <= faces.Length(); ii++)
{
const TopoDS_Face& face_ii = TopoDS::Face(faces(ii));
TopoDS_Wire anOuterWire = BRepTools::OuterWire(face_ii);
TopoDS_Iterator itw(anOuterWire);
for (; itw.More(); itw.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(itw.Value());
if (BRep_Tool::IsClosed(anEdge, face_ii))
{
if (BRepTools::IsReallyClosed(anEdge, face_ii))
{
if (IsUiso(anEdge, face_ii))
{
UseamFound = true;
}
else
{
VseamFound = true;
}
}
else
{
EdgeWith2pcurves = anEdge;
}
}
}
}
SeamFound = UseamFound || VseamFound;
bool aIsEdgeWith2pcurvesSmooth = false;
if (myConcatBSplines && !EdgeWith2pcurves.IsNull() && !SeamFound)
{
const NCollection_List<TopoDS_Shape>& aFaceList =
theGMapEdgeFaces.FindFromKey(EdgeWith2pcurves);
const TopoDS_Face& aFace1 = TopoDS::Face(aFaceList.First());
const TopoDS_Face& aFace2 = TopoDS::Face(aFaceList.Last());
GeomAbs_Shape anOrderOfCont =
BRepLib::ContinuityOfFaces(EdgeWith2pcurves, aFace1, aFace2, myAngTol);
aIsEdgeWith2pcurvesSmooth = (anOrderOfCont >= GeomAbs_G1);
}
if (aIsEdgeWith2pcurvesSmooth)
{
occ::handle<Geom2d_Curve> aPC1, aPC2;
double aFirst, aLast;
aPC1 = BRep_Tool::CurveOnSurface(EdgeWith2pcurves, F_RefFace, aFirst, aLast);
EdgeWith2pcurves.Reverse();
aPC2 = BRep_Tool::CurveOnSurface(EdgeWith2pcurves, F_RefFace, aFirst, aLast);
gp_Pnt2d aPnt1 = aPC1->Value(aFirst);
gp_Pnt2d aPnt2 = aPC2->Value(aFirst);
bool anIsUclosed = (std::abs(aPnt1.X() - aPnt2.X()) > std::abs(aPnt1.Y() - aPnt2.Y()));
bool aToMakeUPeriodic = false, aToMakeVPeriodic = false;
if (anIsUclosed && Uperiod == 0.)
{
aToMakeUPeriodic = true;
}
if (!anIsUclosed && Vperiod == 0.)
{
aToMakeVPeriodic = true;
}
if (aToMakeUPeriodic || aToMakeVPeriodic)
{
occ::handle<Geom_BSplineSurface> aBSplineSurface =
occ::down_cast<Geom_BSplineSurface>(aBaseSurface);
if (aBSplineSurface.IsNull())
{
double aTol = 1.e-4;
GeomAbs_Shape aUCont = GeomAbs_C1, aVCont = GeomAbs_C1;
int degU = 14, degV = 14;
int nmax = 16;
int aPrec = 1;
GeomConvert_ApproxSurface
Approximator(aBaseSurface, aTol, aUCont, aVCont, degU, degV, nmax, aPrec);
aBSplineSurface = Approximator.Surface();
}
if (aToMakeUPeriodic)
{
aBSplineSurface->SetUPeriodic();
Uperiod = aBSplineSurface->UPeriod();
}
if (aToMakeVPeriodic)
{
aBSplineSurface->SetVPeriodic();
Vperiod = aBSplineSurface->VPeriod();
}
// Update ref face and pcurves if the surface changed
if (aBSplineSurface != aBaseSurface)
{
TopoDS_Face OldRefFace = RefFace;
occ::handle<Geom2d_Curve> NullPCurve;
RefFace.Nullify();
BB.MakeFace(RefFace, aBSplineSurface, aBaseLocation, 0.);
for (int ii = 1; ii <= edges.Length(); ii++)
{
TopoDS_Edge anEdge = TopoDS::Edge(edges(ii));
occ::handle<Geom2d_Curve> aPCurve =
BRep_Tool::CurveOnSurface(anEdge, OldRefFace, aFirst, aLast);
if (MapEdgesWithTemporaryPCurves.Contains(anEdge))
{
BB.UpdateEdge(anEdge, NullPCurve, OldRefFace, 0.);
}
BB.UpdateEdge(anEdge, aPCurve, RefFace, 0.);
}
F_RefFace = RefFace;
F_RefFace.Orientation(TopAbs_FORWARD);
}
}
} // if (myConcatBSplines && !EdgeWith2pcurves.IsNull() && !SeamFound)
// Perform relocating to new U-origin
// Define boundaries in 2d space of RefFace
double aPeriods[2] = {Uperiod, Vperiod};
bool anIsSeamFound[2] = {UseamFound, VseamFound};
double aSurfMin[2], aSurfMax[2];
aBaseSurface->Bounds(aSurfMin[0], aSurfMax[0], aSurfMin[1], aSurfMax[1]);
for (int ii = 0; ii < 2; ii++)
{
if (aPeriods[ii] != 0.)
{
// if seam edge exists, do nothing
if (!anIsSeamFound[ii])
{
// try to find the origin of U in 2d space
// so that all the faces are in [origin, origin + Uperiod]
double aMinCoord, aMaxCoord; // Umin, Umax;
int aNumberOfIntervals, i_face_max;
if (!FindCoordBounds(faces,
F_RefFace,
aMapEF,
edgesMap,
ii + 1,
aPeriods[ii],
aMinCoord,
aMaxCoord,
aNumberOfIntervals,
i_face_max))
{
break;
}
if (aMaxCoord - aMinCoord > aPeriods[ii] - 1.e-5)
{
anIsSeamFound[ii] = true;
}
else if (aNumberOfIntervals == 2)
{
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> UsedEdges;
NCollection_DataMap<TopoDS_Shape, occ::handle<Geom2d_Curve>> EdgeNewPCurve;
// Relocate pcurves to new U-origin
if (!RelocatePCurvesToNewUorigin(edges,
faces(i_face_max),
F_RefFace,
CoordTol,
ii + 1,
aPeriods[ii],
VEmap,
EdgeNewPCurve,
UsedEdges))
{
VEmap.Clear();
for (int ind = 1; ind <= edges.Length(); ind++)
{
TopExp::MapShapesAndUniqueAncestors(edges(ind),
TopAbs_VERTEX,
TopAbs_EDGE,
VEmap);
}
break;
}
// PCurves from unused edges (may be degenerated edges)
for (int ind = 1; ind <= edges.Length(); ind++)
{
const TopoDS_Edge& anEdge = TopoDS::Edge(edges(ind));
if (!UsedEdges.Contains(anEdge))
{
double fpar, lpar;
occ::handle<Geom2d_Curve> aPCurve =
BRep_Tool::CurveOnSurface(anEdge, F_RefFace, fpar, lpar);
if (aPCurve.IsNull())
{
EdgeNewPCurve.Clear();
break;
}
aPCurve = new Geom2d_TrimmedCurve(aPCurve, fpar, lpar);
EdgeNewPCurve.Bind(anEdge, aPCurve);
}
}
if (EdgeNewPCurve.Extent() != edges.Length())
{
break;
}
// Restore VEmap
VEmap.Clear();
for (int ind = 1; ind <= edges.Length(); ind++)
{
TopExp::MapShapesAndUniqueAncestors(edges(ind), TopAbs_VERTEX, TopAbs_EDGE, VEmap);
}
// Find NewUmin and NewUmax
double NewCoordMin = RealLast(), NewCoordMax = RealFirst();
for (int jj = 1; jj <= edges.Length(); jj++)
{
const occ::handle<Geom2d_Curve>& aPCurve = EdgeNewPCurve(edges(jj));
UpdateBoundaries(aPCurve,
aPCurve->FirstParameter(),
aPCurve->LastParameter(),
ii + 1,
NewCoordMin,
NewCoordMax);
}
if (NewCoordMax - NewCoordMin < aPeriods[ii] - CoordTol
&& (-Precision::Confusion() >= NewCoordMin
|| NewCoordMin >= aPeriods[ii] + Precision::Confusion()
|| -Precision::Confusion() >= NewCoordMax
|| NewCoordMax >= aPeriods[ii] + Precision::Confusion()))
{
// we can build a face without seam edge:
// update the edges with earlier computed relocated pcurves
// fitting into (NewUorigin, NewUorigin + Uperiod)
double RestSpaceInCoord = aPeriods[ii] - (NewCoordMax - NewCoordMin);
double NewCoordOrigin = NewCoordMin - RestSpaceInCoord / 2;
if (NewCoordOrigin < aSurfMin[ii])
{
NewCoordOrigin = aSurfMin[ii];
}
occ::handle<Geom_Surface> NewSurf;
bool anIsInU = (ii == 0);
if (NewCoordOrigin == aSurfMin[ii])
{
NewSurf = aBaseSurface;
}
else
{
NewSurf = new Geom_RectangularTrimmedSurface(aBaseSurface,
NewCoordOrigin,
NewCoordOrigin + aPeriods[ii],
anIsInU); // trim in U or V
}
TopoDS_Face OldRefFace = RefFace;
occ::handle<Geom2d_Curve> NullPCurve;
RefFace.Nullify();
BB.MakeFace(RefFace, NewSurf, aBaseLocation, 0.);
for (int jj = 1; jj <= edges.Length(); jj++)
{
TopoDS_Edge anEdge = TopoDS::Edge(edges(jj));
if (MapEdgesWithTemporaryPCurves.Contains(anEdge))
{
BB.UpdateEdge(anEdge, NullPCurve, OldRefFace, 0.);
}
const occ::handle<Geom2d_Curve>& aPCurve = EdgeNewPCurve(anEdge);
BB.UpdateEdge(anEdge, aPCurve, RefFace, 0.);
}
}
} // else (Umax - Umin < Uperiod - 1.e-5, no Useam)
} // if (!UseamFound)
} // if (Uperiod != 0.)
}
UseamFound = anIsSeamFound[0];
VseamFound = anIsSeamFound[1];
////////////////////////////////////
F_RefFace = RefFace;
F_RefFace.Orientation(TopAbs_FORWARD);
NCollection_Sequence<TopoDS_Shape> NewFaces, NewWires;
if (Uperiod == 0 || Vperiod == 0)
{
// Set the "periods" for closed non-periodic surface
TopLoc_Location aLoc;
occ::handle<Geom_Surface> aSurf = BRep_Tool::Surface(RefFace, aLoc);
if (aSurf->IsKind(STANDARD_TYPE(Geom_RectangularTrimmedSurface)))
{
aSurf = (occ::down_cast<Geom_RectangularTrimmedSurface>(aSurf))->BasisSurface();
}
double Ufirst, Ulast, Vfirst, Vlast;
aSurf->Bounds(Ufirst, Ulast, Vfirst, Vlast);
if (Uperiod == 0 && aSurf->IsUClosed())
{
Uperiod = Ulast - Ufirst;
}
if (Vperiod == 0 && aSurf->IsVClosed())
{
Vperiod = Vlast - Vfirst;
}
}
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> UsedEdges;
bool isWireBuildingFailed = false;
double FaceUmin = RealLast();
double FaceVmin = RealLast();
for (int ii = 1; ii <= edges.Length(); ii++)
{
const TopoDS_Edge& anEdge = TopoDS::Edge(edges(ii));
BRepAdaptor_Curve2d aBAcurve(anEdge, F_RefFace);
if (aBAcurve.Curve().IsNull())
{
continue;
}
gp_Pnt2d aFirstPoint = aBAcurve.Value(aBAcurve.FirstParameter());
gp_Pnt2d aLastPoint = aBAcurve.Value(aBAcurve.LastParameter());
if (aFirstPoint.X() < FaceUmin)
{
FaceUmin = aFirstPoint.X();
}
if (aLastPoint.X() < FaceUmin)
{
FaceUmin = aLastPoint.X();
}
if (aFirstPoint.Y() < FaceVmin)
{
FaceVmin = aFirstPoint.Y();
}
if (aLastPoint.Y() < FaceVmin)
{
FaceVmin = aLastPoint.Y();
}
}
// Building new wires from <edges>
// and build faces
while (!edges.IsEmpty())
{
// try to find non-degenerated edge
TopoDS_Edge StartEdge = TopoDS::Edge(edges(1));
int istart = 1;
while (BRep_Tool::Degenerated(StartEdge) && istart < edges.Length())
{
istart++;
StartEdge = TopoDS::Edge(edges(istart));
}
TopoDS_Wire aNewWire;
BB.MakeWire(aNewWire);
BB.Add(aNewWire, StartEdge);
RemoveEdgeFromMap(StartEdge, VEmap);
NCollection_IndexedMap<TopoDS_Shape, TopTools_ShapeMapHasher> SplittingVertices;
double fpar, lpar;
occ::handle<Geom2d_Curve> StartPCurve =
BRep_Tool::CurveOnSurface(StartEdge, F_RefFace, fpar, lpar);
if (StartPCurve.IsNull())
{
edges.Remove(istart);
continue;
}
TopoDS_Vertex StartVertex, CurVertex;
TopExp::Vertices(StartEdge, StartVertex, CurVertex, true); // with orientation
double StartParam, CurParam;
if (StartEdge.Orientation() == TopAbs_FORWARD)
{
StartParam = fpar;
CurParam = lpar;
}
else
{
StartParam = lpar;
CurParam = fpar;
}
gp_Pnt2d StartPoint = StartPCurve->Value(StartParam);
gp_Pnt2d CurPoint = StartPCurve->Value(CurParam);
TopoDS_Edge CurEdge = StartEdge;
for (;;) // loop till the end of current new wire
{
TopoDS_Edge NextEdge;
gp_Pnt2d NextPoint;
NCollection_List<TopoDS_Shape> Elist;
// const NCollection_List<TopoDS_Shape>& Elist = VEmap.FindFromKey(CurVertex);
if (VEmap.Contains(CurVertex))
{
Elist = VEmap.FindFromKey(CurVertex);
}
NCollection_List<TopoDS_Shape>::Iterator itl(Elist);
if (Elist.IsEmpty())
{
if (CurVertex.IsSame(StartVertex))
{
// Points of two vertices coincide in 3d but may be not in 2d
if ((Uperiod != 0. && std::abs(StartPoint.X() - CurPoint.X()) > Uperiod / 2)
|| (Vperiod != 0.
&& std::abs(StartPoint.Y() - CurPoint.Y())
> Vperiod / 2)) // end of parametric space
{
//<edges> do not contain seams => we must reconstruct the seam up to <NextEdge>
ReconstructMissedSeam(RemovedEdges,
F_RefFace,
CurEdge,
CurVertex,
CurPoint,
Uperiod,
Vperiod,
NextEdge,
NextPoint);
}
else
{
break; // end of wire
}
}
}
if (NextEdge.IsNull())
{
bool EndOfWire = false;
bool anIsOnSingularity = IsOnSingularity(Elist);
if (!anIsOnSingularity && Elist.Extent() > 1)
{
SplittingVertices.Add(CurVertex);
}
NCollection_List<TopoDS_Shape> TmpElist, TrueElist;
//<TrueElist> will be the list of candidates to become <NextEdge>
for (itl.Initialize(Elist); itl.More(); itl.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(itl.Value());
if (UsedEdges.Contains(anEdge))
{
continue;
}
TopoDS_Vertex aFirstVertex = TopExp::FirstVertex(anEdge, true);
if (!aFirstVertex.IsSame(CurVertex))
{
continue;
}
TmpElist.Append(anEdge);
}
occ::handle<Geom2d_Curve> CurPCurve =
BRep_Tool::CurveOnSurface(CurEdge, F_RefFace, fpar, lpar);
if (TmpElist.Extent() <= 1 || (Uperiod != 0. || Vperiod != 0) || CurPCurve.IsNull())
{
TrueElist.Assign(TmpElist);
}
else
{
// we must choose the closest direction - the biggest angle
double MaxAngle = RealFirst();
TopoDS_Edge TrueEdge;
CurParam = (CurEdge.Orientation() == TopAbs_FORWARD) ? lpar : fpar;
auto [aCurPoint, CurDir] = CurPCurve->EvalD1(CurParam);
CurPoint = aCurPoint;
CurDir.Normalize();
if (CurEdge.Orientation() == TopAbs_REVERSED)
{
CurDir.Reverse();
}
for (itl.Initialize(TmpElist); itl.More(); itl.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(itl.Value());
occ::handle<Geom2d_Curve> aPCurve =
BRep_Tool::CurveOnSurface(anEdge, F_RefFace, fpar, lpar);
if (aPCurve.IsNull())
{
// edge has no pcurve on the reference face, skip it as a direction candidate
continue;
}
const double aParam = (anEdge.Orientation() == TopAbs_FORWARD) ? fpar : lpar;
gp_Vec2d aDir = aPCurve->EvalD1(aParam).D1;
aDir.Normalize();
if (anEdge.Orientation() == TopAbs_REVERSED)
{
aDir.Reverse();
}
double anAngle = CurDir.Angle(aDir);
if (anAngle > MaxAngle)
{
MaxAngle = anAngle;
TrueEdge = anEdge;
}
}
if (!TrueEdge.IsNull())
{
TrueElist.Append(TrueEdge);
}
}
// Find next edge in TrueElist
for (itl.Initialize(TrueElist); itl.More(); itl.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(itl.Value());
occ::handle<Geom2d_Curve> aPCurve =
BRep_Tool::CurveOnSurface(anEdge, F_RefFace, fpar, lpar);
if (aPCurve.IsNull())
{
// edge has no pcurve on the reference face, skip it as a next-edge candidate
continue;
}
double aParam = (anEdge.Orientation() == TopAbs_FORWARD) ? fpar : lpar;
gp_Pnt2d aPoint = aPCurve->Value(aParam);
double DiffU = std::abs(aPoint.X() - CurPoint.X());
double DiffV = std::abs(aPoint.Y() - CurPoint.Y());
if (Uperiod != 0. && DiffU > CoordTol && std::abs(DiffU - Uperiod) > CoordTol)
{ // may be it is a deg.vertex
continue;
}
if (Vperiod != 0. && DiffV > CoordTol && std::abs(DiffV - Vperiod) > CoordTol)
{ // may be it is a deg.vertex
continue;
}
// Check: may be <CurPoint> and <aPoint> are on Period from each other
if ((Uperiod != 0. && DiffU > Uperiod / 2)
|| (Vperiod != 0. && DiffV > Vperiod / 2)) // end of parametric space
{
//<edges> do not contain seams => we must reconstruct the seam up to <NextEdge>
gp_Pnt2d StartOfNextEdge;
TopoDS_Vertex LastVertexOfSeam;
ReconstructMissedSeam(RemovedEdges,
F_RefFace,
CurEdge,
CurVertex,
CurPoint,
Uperiod,
Vperiod,
NextEdge,
NextPoint);
// Check: may be it is the end
if (LastVertexOfSeam.IsSame(StartVertex)
&& std::abs(StartPoint.X() - StartOfNextEdge.X()) < Uperiod / 2)
{
EndOfWire = true;
}
break;
}
else
{
NextEdge = anEdge;
double LastParam = (NextEdge.Orientation() == TopAbs_FORWARD) ? lpar : fpar;
NextPoint = aPCurve->Value(LastParam);
break;
}
} // for (itl.Initialize(TrueElist); itl.More(); itl.Next())
if (EndOfWire)
{
break;
}
}
if (NextEdge.IsNull())
{
if (Uperiod != 0. || Vperiod != 0.)
{
if (CurVertex.IsSame(StartVertex)
&& (Uperiod == 0. || std::abs(StartPoint.X() - CurPoint.X()) < Uperiod / 2)
&& (Vperiod == 0. || std::abs(StartPoint.Y() - CurPoint.Y()) < Vperiod / 2))
{
break; // end of wire
}
ReconstructMissedSeam(RemovedEdges,
F_RefFace,
CurEdge,
CurVertex,
CurPoint,
Uperiod,
Vperiod,
NextEdge,
NextPoint);
if (NextEdge.IsNull())
{
isWireBuildingFailed = true;
break;
}
}
else
{
isWireBuildingFailed = true;
break;
}
}
CurPoint = NextPoint;
CurEdge = NextEdge;
CurVertex = TopExp::LastVertex(CurEdge, true); // with orientation
BB.Add(aNewWire, CurEdge);
UsedEdges.Add(CurEdge);
RemoveEdgeFromMap(CurEdge, VEmap);
} // for (;;)
if (isWireBuildingFailed)
{
break;
}
aNewWire.Closed(true);
UsedEdges.Add(StartEdge);
// Remove used edges from sequence
int ind = 1;
while (ind <= edges.Length())
{
if (UsedEdges.Contains(edges(ind)))
{
edges.Remove(ind);
}
else
{
ind++;
}
}
// add just built wire to current face or save it in the sequence of wires
bool EdgeOnBoundOfSurfFound = false;
TopoDS_Iterator itw(aNewWire);
for (; itw.More(); itw.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(itw.Value());
if (BRep_Tool::IsClosed(anEdge, RefFace))
{
EdgeOnBoundOfSurfFound = true;
break;
}
}
if (EdgeOnBoundOfSurfFound) // this wire can not be a hole
{
TopLoc_Location aLoc;
occ::handle<Geom_Surface> aSurf = BRep_Tool::Surface(RefFace, aLoc);
TopoDS_Face aResult;
BB.MakeFace(aResult, aSurf, aLoc, 0);
BB.Add(aResult, aNewWire);
aResult.Orientation(RefFaceOrientation);
NewFaces.Append(aResult);
}
else // may be this wire is a hole
{
// split this wire if needed
if (!SplittingVertices.IsEmpty())
{
SplitWire(aNewWire, F_RefFace, SplittingVertices, NewWires);
}
else
{
NewWires.Append(aNewWire);
}
}
} // while (!edges.IsEmpty())
if (isWireBuildingFailed)
{
continue;
}
// Build wires from internal edges
NCollection_IndexedDataMap<TopoDS_Shape,
NCollection_List<TopoDS_Shape>,
TopTools_ShapeMapHasher>
IntVEmap;
for (int ii = 1; ii <= InternalEdges.Extent(); ii++)
{
TopExp::MapShapesAndAncestors(InternalEdges(ii), TopAbs_VERTEX, TopAbs_EDGE, IntVEmap);
}
NCollection_Sequence<TopoDS_Shape> InternalWires;
while (!InternalEdges.IsEmpty())
{
TopoDS_Edge aFirstEdge = TopoDS::Edge(InternalEdges(1));
InternalEdges.RemoveFromIndex(1);
RemoveEdgeFromMap(aFirstEdge, IntVEmap);
TopoDS_Wire anInternalWire;
BB.MakeWire(anInternalWire);
BB.Add(anInternalWire, aFirstEdge);
TopoDS_Edge EndEdges[2];
EndEdges[0] = EndEdges[1] = aFirstEdge;
TopoDS_Vertex VV[2];
TopExp::Vertices(aFirstEdge, VV[0], VV[1]);
for (;;)
{
if (VV[0].IsSame(VV[1]))
{ // closed wire
break;
}
bool found = false;
for (int ii = 0; ii < 2; ii++)
{
const NCollection_List<TopoDS_Shape>& Elist = IntVEmap.FindFromKey(VV[ii]);
NCollection_List<TopoDS_Shape>::Iterator itl(Elist);
for (; itl.More(); itl.Next())
{
TopoDS_Edge anEdge = TopoDS::Edge(itl.Value());
if (anEdge.IsSame(EndEdges[ii]))
{
continue;
}
found = true;
InternalEdges.RemoveKey(anEdge);
RemoveEdgeFromMap(anEdge, IntVEmap);
BB.Add(anInternalWire, anEdge);
TopoDS_Vertex V1, V2;
TopExp::Vertices(anEdge, V1, V2);
VV[ii] = (V1.IsSame(VV[ii])) ? V2 : V1;
EndEdges[ii] = anEdge;
break;
}
}
if (!found)
{ // end of open wire
break;
}
}
InternalWires.Append(anInternalWire);
}
// Insert new faces instead of old ones
if (NewFaces.IsEmpty())
{
// one face without seam
TopLoc_Location aLoc;
occ::handle<Geom_Surface> aSurf = BRep_Tool::Surface(RefFace, aLoc);
TopoDS_Face aResult;
BB.MakeFace(aResult, aSurf, aLoc, 0.);
for (int ii = 1; ii <= NewWires.Length(); ii++)
{
BB.Add(aResult, NewWires(ii));
}
for (int ii = 1; ii <= InternalWires.Length(); ii++)
{
BB.Add(aResult, InternalWires(ii));
}
aResult.Orientation(RefFaceOrientation);
myContext->Merge(faces, aResult);
// Update the map Face-NewFace
for (int jj = 1; jj <= faces.Length(); jj++)
{
myFaceNewFace.Bind(faces(jj), aResult);
}
}
else if (NewFaces.Length() == 1)
{
TopoDS_Shape aNewFace = NewFaces(1).Oriented(TopAbs_FORWARD);
for (int ii = 1; ii <= NewWires.Length(); ii++)
{
BB.Add(aNewFace, NewWires(ii));
}
for (int ii = 1; ii <= InternalWires.Length(); ii++)
{
BB.Add(aNewFace, InternalWires(ii));
}
myContext->Merge(faces, NewFaces(1));
// Update the map Face-NewFace
for (int jj = 1; jj <= faces.Length(); jj++)
{
myFaceNewFace.Bind(faces(jj), NewFaces(1));
}
}
else
{
// Insert new wires and internal wires into correspondent faces
InsertWiresIntoFaces(NewWires, NewFaces, RefFace);
InsertWiresIntoFaces(InternalWires, NewFaces, RefFace);
NCollection_Sequence<NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher>> Emaps;
for (int ii = 1; ii <= faces.Length(); ii++)
{
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> aEmap;
TopExp::MapShapes(faces(ii), aEmap);
Emaps.Append(aEmap);
}
for (int ii = 1; ii <= NewFaces.Length(); ii++)
{
NCollection_Sequence<TopoDS_Shape> facesForThisFace;
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> UsedFaces;
TopExp_Explorer Explo(NewFaces(ii), TopAbs_EDGE);
for (; Explo.More(); Explo.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(Explo.Current());
if (BRep_Tool::Degenerated(anEdge) || BRep_Tool::IsClosed(anEdge, RefFace))
{
continue;
}
int jj;
for (jj = 1; jj <= Emaps.Length(); jj++)
{
if (Emaps(jj).Contains(anEdge))
{
break;
}
}
if (UsedFaces.Add(faces(jj)))
{
facesForThisFace.Append(faces(jj));
}
}
myContext->Merge(facesForThisFace, NewFaces(ii));
// Update the map Face-NewFace
for (int jj = 1; jj <= facesForThisFace.Length(); jj++)
{
myFaceNewFace.Bind(facesForThisFace(jj), NewFaces(ii));
}
}
}
} // if (faces.Length() > 1)
} // end processing each face
}
//=================================================================================================
void ShapeUpgrade_UnifySameDomain::UnifyEdges()
{
TopoDS_Shape aRes = myContext->Apply(myShape);
// creating map of edge faces
NCollection_IndexedDataMap<TopoDS_Shape, NCollection_List<TopoDS_Shape>, TopTools_ShapeMapHasher>
aMapEdgeFaces;
TopExp::MapShapesAndAncestors(aRes, TopAbs_EDGE, TopAbs_FACE, aMapEdgeFaces);
// creating map of vertex edges
NCollection_IndexedDataMap<TopoDS_Shape, NCollection_List<TopoDS_Shape>, TopTools_ShapeMapHasher>
aMapEdgesVertex;
TopExp::MapShapesAndUniqueAncestors(aRes, TopAbs_VERTEX, TopAbs_EDGE, aMapEdgesVertex);
// creating map of vertex faces
NCollection_IndexedDataMap<TopoDS_Shape, NCollection_List<TopoDS_Shape>, TopTools_ShapeMapHasher>
aVFmap;
TopExp::MapShapesAndUniqueAncestors(aRes, TopAbs_VERTEX, TopAbs_FACE, aVFmap);
if (mySafeInputMode)
{
UpdateMapOfShapes(myKeepShapes, myContext);
}
// Sequence of the edges of the shape
NCollection_Sequence<TopoDS_Shape> aSeqEdges;
const int aNbE = aMapEdgeFaces.Extent();
for (int i = 1; i <= aNbE; ++i)
{
aSeqEdges.Append(aMapEdgeFaces.FindKey(i));
}
// Prepare map of shared vertices (with the number of connected edges greater then 2)
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> aSharedVert;
CheckSharedVertices(aSeqEdges, aMapEdgesVertex, myKeepShapes, aSharedVert);
// Merge the edges avoiding removal of the shared vertices
bool isMerged = MergeSeq(aSeqEdges, aVFmap, aSharedVert);
// Collect faces to rebuild
NCollection_IndexedMap<TopoDS_Shape, TopTools_ShapeMapHasher> aChangedFaces;
if (isMerged)
{
for (int i = 1; i <= aNbE; ++i)
{
const TopoDS_Shape& aE = aMapEdgeFaces.FindKey(i);
if (myContext->IsRecorded(aE))
{
NCollection_List<TopoDS_Shape>::Iterator it(aMapEdgeFaces(i));
for (; it.More(); it.Next())
{
aChangedFaces.Add(it.Value());
}
}
}
}
// fix changed faces and replace them in the local context
constexpr double aPrec = Precision::Confusion();
for (int i = 1; i <= aChangedFaces.Extent(); i++)
{
TopoDS_Face aFace = TopoDS::Face(myContext->Apply(aChangedFaces.FindKey(i)));
if (aFace.IsNull())
{
continue;
}
// for a planar face create and store pcurve of edge on face
// to speed up all operations; but this is allowed only when non-safe mode in force
if (!mySafeInputMode)
{
TopLoc_Location aLoc;
occ::handle<Geom_Surface> aSurface = BRep_Tool::Surface(aFace, aLoc);
aSurface = ClearRts(aSurface);
if (aSurface->IsKind(STANDARD_TYPE(Geom_Plane)))
{
NCollection_List<TopoDS_Shape> aLE;
for (TopExp_Explorer anEx(aFace, TopAbs_EDGE); anEx.More(); anEx.Next())
{
aLE.Append(anEx.Current());
}
BRepLib::BuildPCurveForEdgesOnPlane(aLE, aFace);
}
}
ShapeFix_Face sff(aFace);
if (mySafeInputMode)
{
sff.SetContext(myContext);
}
sff.SetPrecision(aPrec);
sff.SetMinTolerance(aPrec);
sff.SetMaxTolerance(std::max(1., aPrec * 1000.));
sff.FixOrientationMode() = 0;
sff.FixAddNaturalBoundMode() = 0;
sff.FixIntersectingWiresMode() = 0;
sff.FixLoopWiresMode() = 0;
sff.FixSplitFaceMode() = 0;
sff.FixPeriodicDegeneratedMode() = 0;
SetFixWireModes(sff);
sff.Perform();
TopoDS_Shape aNewFace = sff.Face();
myContext->Replace(aFace, aNewFace);
}
if (aChangedFaces.Extent() > 0)
{
// fix changed shell and replace it in the local context
TopoDS_Shape aRes1 = myContext->Apply(aRes);
bool isChanged = false;
TopExp_Explorer expsh;
for (expsh.Init(aRes1, TopAbs_SHELL); expsh.More(); expsh.Next())
{
TopoDS_Shell aShell = TopoDS::Shell(expsh.Current());
occ::handle<ShapeFix_Shell> sfsh = new ShapeFix_Shell;
sfsh->FixFaceOrientation(aShell);
TopoDS_Shape aNewShell = sfsh->Shell();
if (!aNewShell.IsSame(aShell))
{
myContext->Replace(aShell, aNewShell);
isChanged = true;
}
}
if (isChanged)
{
aRes1 = myContext->Apply(aRes1);
}
myContext->Replace(myShape, aRes1);
}
myShape = myContext->Apply(myShape);
}
//=================================================================================================
void ShapeUpgrade_UnifySameDomain::Build()
{
TopExp::MapShapesAndAncestors(myInitShape, TopAbs_EDGE, TopAbs_FACE, myEFmap);
if (myUnifyFaces)
{
UnifyFaces();
}
if (myUnifyEdges)
{
UnifyEdges();
}
// Fill the history of modifications during the operation
FillHistory();
}
//=======================================================================
// function : FillHistory
// purpose : Fill the history of modifications during the operation
//=======================================================================
void ShapeUpgrade_UnifySameDomain::FillHistory()
{
if (myHistory.IsNull())
{
// History is not requested
return;
}
// Only Vertices, Edges and Faces can be modified during unification.
// Thus, only these kind of shapes should be checked.
// Get history from the context.
// It contains all modifications of the operation. Some of these
// modifications become not relevant and should be filtered.
occ::handle<BRepTools_History> aCtxHistory = myContext->History();
// Explore the history of the context and fill
// the history of UnifySameDomain algorithm
occ::handle<BRepTools_History> aUSDHistory = new BRepTools_History();
// Map all Vertices, Edges, Faces and Solids in the input shape
NCollection_IndexedMap<TopoDS_Shape, TopTools_ShapeMapHasher> aMapInputShape;
TopExp::MapShapes(myInitShape, TopAbs_VERTEX, aMapInputShape);
TopExp::MapShapes(myInitShape, TopAbs_EDGE, aMapInputShape);
TopExp::MapShapes(myInitShape, TopAbs_FACE, aMapInputShape);
TopExp::MapShapes(myInitShape, TopAbs_SOLID, aMapInputShape);
// Map all Vertices, Edges, Faces and Solids in the result shape
NCollection_IndexedMap<TopoDS_Shape, TopTools_ShapeMapHasher> aMapResultShapes;
TopExp::MapShapes(myShape, TopAbs_VERTEX, aMapResultShapes);
TopExp::MapShapes(myShape, TopAbs_EDGE, aMapResultShapes);
TopExp::MapShapes(myShape, TopAbs_FACE, aMapResultShapes);
TopExp::MapShapes(myShape, TopAbs_SOLID, aMapResultShapes);
// Iterate on all input shapes and get their modifications
int i, aNb = aMapInputShape.Extent();
for (i = 1; i <= aNb; ++i)
{
const TopoDS_Shape& aS = aMapInputShape(i);
// Check the shape itself to be present in the result
if (aMapResultShapes.Contains(aS))
{
// The shape is present in the result as is, thus has not been modified
continue;
}
// Check if the shape has been modified during the operation
const NCollection_List<TopoDS_Shape>& aLSImages = aCtxHistory->Modified(aS);
if (aLSImages.IsEmpty())
{
// The shape has not been modified and not present in the result,
// thus it has been removed
aUSDHistory->Remove(aS);
continue;
}
// Check the images of the shape to be present in the result
bool bRemoved = true;
NCollection_List<TopoDS_Shape>::Iterator aItLSIm(aLSImages);
for (; aItLSIm.More(); aItLSIm.Next())
{
const TopoDS_Shape& aSIm = aItLSIm.Value();
if (aMapResultShapes.Contains(aSIm))
{
if (!aSIm.IsSame(aS))
{
// Image is found in the result, thus the shape has been modified
aUSDHistory->AddModified(aS, aSIm);
}
bRemoved = false;
}
}
if (bRemoved)
{
// No images are found in the result, thus the shape has been removed
aUSDHistory->Remove(aS);
}
}
// Merge the history of the operation into global history
myHistory->Merge(aUSDHistory);
}
void SplitWire(const TopoDS_Wire& theWire,
const TopoDS_Face& theFace,
const NCollection_IndexedMap<TopoDS_Shape, TopTools_ShapeMapHasher>& theVmap,
NCollection_Sequence<TopoDS_Shape>& theWireSeq)
{
NCollection_DataMap<TopoDS_Shape, NCollection_List<TopoDS_Shape>, TopTools_ShapeMapHasher> aVEmap;
NCollection_Map<TopoDS_Shape, TopTools_ShapeMapHasher> aEmap;
TopoDS_Iterator itw(theWire);
for (; itw.More(); itw.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(itw.Value());
if (!aEmap.Add(anEdge))
{
continue;
}
if (anEdge.Orientation() != TopAbs_FORWARD && anEdge.Orientation() != TopAbs_REVERSED)
{
continue;
}
const TopoDS_Vertex& aVertex = TopExp::FirstVertex(anEdge, true); // with orientation
if (aVEmap.IsBound(aVertex))
{
aVEmap(aVertex).Append(anEdge);
}
else
{
NCollection_List<TopoDS_Shape> aElist;
aElist.Append(anEdge);
aVEmap.Bind(aVertex, aElist);
}
}
BRep_Builder aBB;
for (int ii = 1; ii <= theVmap.Extent(); ii++)
{
const TopoDS_Vertex& anOrigin = TopoDS::Vertex(theVmap(ii));
NCollection_List<TopoDS_Shape>& aBranches = aVEmap(anOrigin);
NCollection_List<TopoDS_Shape>::Iterator anItl(aBranches);
while (anItl.More())
{
TopoDS_Edge CurEdge = TopoDS::Edge(anItl.Value());
aBranches.Remove(anItl);
TopoDS_Wire aNewWire;
aBB.MakeWire(aNewWire);
for (;;)
{
aBB.Add(aNewWire, CurEdge);
// clang-format off
const TopoDS_Vertex& aVertex = TopExp::LastVertex (CurEdge, true); //with orientation
// clang-format on
if (aVertex.IsSame(anOrigin))
{
break;
}
if (!aVEmap.IsBound(aVertex))
{
break;
}
NCollection_List<TopoDS_Shape>& aElist = aVEmap(aVertex);
if (aElist.Extent() == 0)
{
break;
}
double fpar, lpar;
occ::handle<Geom2d_Curve> aPCurve = BRep_Tool::CurveOnSurface(CurEdge, theFace, fpar, lpar);
if (aElist.Extent() == 1)
{
CurEdge = TopoDS::Edge(aElist.First());
aElist.Clear();
}
else if (aPCurve.IsNull())
{
CurEdge = TopoDS::Edge(aElist.First());
aElist.RemoveFirst();
}
else
{
double aParam = (CurEdge.Orientation() == TopAbs_FORWARD) ? lpar : fpar;
gp_Vec2d CurDir = aPCurve->EvalD1(aParam).D1;
CurDir.Normalize();
if (CurEdge.Orientation() == TopAbs_REVERSED)
{
CurDir.Reverse();
}
// choose the rightest direction - the smallest angle
double MinAngle = RealLast();
TopoDS_Edge NextEdge;
NCollection_List<TopoDS_Shape>::Iterator aLocalIter(aElist);
for (; aLocalIter.More(); aLocalIter.Next())
{
const TopoDS_Edge& anEdge = TopoDS::Edge(aLocalIter.Value());
aPCurve = BRep_Tool::CurveOnSurface(anEdge, theFace, fpar, lpar);
if (aPCurve.IsNull())
{
// edge has no pcurve on the reference face, skip it as a direction candidate
continue;
}
aParam = (anEdge.Orientation() == TopAbs_FORWARD) ? fpar : lpar;
gp_Vec2d aDir = aPCurve->EvalD1(aParam).D1;
aDir.Normalize();
if (anEdge.Orientation() == TopAbs_REVERSED)
{
aDir.Reverse();
}
double anAngle = CurDir.Angle(aDir);
if (anAngle < MinAngle)
{
MinAngle = anAngle;
NextEdge = anEdge;
}
}
if (NextEdge.IsNull())
{
// all candidates lacked a pcurve, fall back to an arbitrary one instead of stalling
NextEdge = TopoDS::Edge(aElist.First());
}
CurEdge = NextEdge;
// Remove <CurEdge> from list
for (aLocalIter.Initialize(aElist); aLocalIter.More(); aLocalIter.Next())
{
if (CurEdge.IsSame(aLocalIter.Value()))
{
aElist.Remove(aLocalIter);
break;
}
}
} // else (more than one edge)
} // for (;;)
theWireSeq.Append(aNewWire);
} // while (anItl.More())
}
}