+ aBuilder.MakeCompound(aResultComp);
+ for(ListOfShape::const_iterator anIter = theCombinedShapes.cbegin(); anIter != theCombinedShapes.cend(); anIter++) {
+ aBuilder.Add(aResultComp, (*anIter)->impl<TopoDS_Shape>());
+ }
+ for(ListOfShape::const_iterator anIter = theFreeShapes.cbegin(); anIter != theFreeShapes.cend(); anIter++) {
+ aBuilder.Add(aResultComp, (*anIter)->impl<TopoDS_Shape>());
+ }
+ aResult->setImpl(new TopoDS_Shape(aResultComp));
+ }
+
+ return aResult;
+}
+
+//==================================================================================================
+static void addSimpleShapeToList(const TopoDS_Shape& theShape, NCollection_List<TopoDS_Shape>& theList)
+{
+ if(theShape.IsNull()) {
+ return;
+ }
+
+ if(theShape.ShapeType() == TopAbs_COMPOUND) {
+ for(TopoDS_Iterator anIt(theShape); anIt.More(); anIt.Next()) {
+ addSimpleShapeToList(anIt.Value(), theList);
+ }
+ } else {
+ theList.Append(theShape);
+ }
+}
+
+//==================================================================================================
+static TopoDS_Compound makeCompound(const NCollection_List<TopoDS_Shape> theShapes)
+{
+ TopoDS_Compound aCompound;
+
+ BRep_Builder aBuilder;
+ aBuilder.MakeCompound(aCompound);
+
+ for(NCollection_List<TopoDS_Shape>::Iterator anIt(theShapes); anIt.More(); anIt.Next()) {
+ aBuilder.Add(aCompound, anIt.Value());
+ }
+
+ return aCompound;
+}
+
+//==================================================================================================
+std::shared_ptr<GeomAPI_Shape> GeomAlgoAPI_ShapeTools::groupSharedTopology(const std::shared_ptr<GeomAPI_Shape> theCompound)
+{
+ GeomShapePtr aResult = theCompound;
+
+ if(!theCompound.get()) {
+ return aResult;
+ }
+
+ TopoDS_Shape anInShape = aResult->impl<TopoDS_Shape>();
+ NCollection_List<TopoDS_Shape> anUngroupedShapes;
+ addSimpleShapeToList(anInShape, anUngroupedShapes);
+
+ NCollection_Vector<NCollection_List<TopoDS_Shape>> aGroups;
+ while(!anUngroupedShapes.IsEmpty()) {
+ NCollection_List<TopoDS_Shape> aGroupedShapes;
+ aGroupedShapes.Append(anUngroupedShapes.First());
+ anUngroupedShapes.RemoveFirst();
+ for(NCollection_List<TopoDS_Shape>::Iterator aGroupIt(aGroupedShapes); aGroupIt.More(); aGroupIt.Next()) {
+ const TopoDS_Shape& aGroupShape = aGroupIt.Value();
+ for(NCollection_List<TopoDS_Shape>::Iterator anUngroupedIt(anUngroupedShapes); anUngroupedIt.More(); anUngroupedIt.Next()) {
+ const TopoDS_Shape& anUngroupedShape = anUngroupedIt.Value();
+ bool isFound = false;
+ for(TopExp_Explorer aGroupShapeExp(aGroupShape, TopAbs_VERTEX); aGroupShapeExp.More(); aGroupShapeExp.Next()) {
+ const TopoDS_Shape& aVertex1 = aGroupShapeExp.Current();
+ for(TopExp_Explorer anUngroupedShapeExp(anUngroupedShape, TopAbs_VERTEX); anUngroupedShapeExp.More(); anUngroupedShapeExp.Next()) {
+ const TopoDS_Shape& aVertex2 = anUngroupedShapeExp.Current();
+ if(aVertex1.IsSame(aVertex2)) {
+ aGroupedShapes.Append(anUngroupedShape);
+ anUngroupedShapes.Remove(anUngroupedIt);
+ isFound = true;
+ break;
+ }
+ }
+ if(isFound) {
+ break;
+ }
+ }
+ if(!anUngroupedIt.More()) {
+ break;
+ }
+ }
+ }
+ aGroups.Append(aGroupedShapes);
+ }
+
+ if(aGroups.Size() == 1) {
+ NCollection_List<TopoDS_Shape> aGroup = aGroups.First();
+ GeomShapePtr aGeomShape(new GeomAPI_Shape());
+ aGeomShape->setImpl(new TopoDS_Shape(makeCompound(aGroup)));
+ ListOfShape aCompSolids, aFreeSolids;
+ aGeomShape = GeomAlgoAPI_ShapeTools::combineShapes(aGeomShape,
+ GeomAPI_Shape::COMPSOLID,
+ aCompSolids,
+ aFreeSolids);
+ aResult = aGeomShape;
+ } else {
+ TopoDS_Compound aCompound;
+ BRep_Builder aBuilder;
+ aBuilder.MakeCompound(aCompound);
+ ListOfShape aCompSolids, aFreeSolids;
+ for(NCollection_Vector<NCollection_List<TopoDS_Shape>>::Iterator anIt(aGroups); anIt.More(); anIt.Next()) {
+ NCollection_List<TopoDS_Shape> aGroup = anIt.Value();
+ GeomShapePtr aGeomShape(new GeomAPI_Shape());
+ if(aGroup.Size() == 1) {
+ aGeomShape->setImpl(new TopoDS_Shape(aGroup.First()));
+ } else {
+ aGeomShape->setImpl(new TopoDS_Shape(makeCompound(aGroup)));
+ aGeomShape = GeomAlgoAPI_ShapeTools::combineShapes(aGeomShape,
+ GeomAPI_Shape::COMPSOLID,
+ aCompSolids,
+ aFreeSolids);
+ }
+ aBuilder.Add(aCompound, aGeomShape->impl<TopoDS_Shape>());
+ }
+
+ if(!aCompound.IsNull()) {
+ aResult->setImpl(new TopoDS_Shape(aCompound));
+ }
+ }
+
+ return aResult;
+}
+
+//==================================================================================================
+std::list<std::shared_ptr<GeomAPI_Pnt> > GeomAlgoAPI_ShapeTools::getBoundingBox(const ListOfShape& theShapes, const double theEnlarge)
+{
+ // Bounding box of all objects.
+ Bnd_Box aBndBox;
+
+ // Getting box.
+ for (ListOfShape::const_iterator anObjectsIt = theShapes.begin(); anObjectsIt != theShapes.end(); anObjectsIt++) {
+ const TopoDS_Shape& aShape = (*anObjectsIt)->impl<TopoDS_Shape>();
+ BRepBndLib::Add(aShape, aBndBox);
+ }
+
+ if(theEnlarge != 0.0) {
+ // We enlarge bounding box just to be sure that plane will be large enough to cut all objects.
+ aBndBox.Enlarge(theEnlarge);
+ }
+
+ Standard_Real aXArr[2] = {aBndBox.CornerMin().X(), aBndBox.CornerMax().X()};
+ Standard_Real aYArr[2] = {aBndBox.CornerMin().Y(), aBndBox.CornerMax().Y()};
+ Standard_Real aZArr[2] = {aBndBox.CornerMin().Z(), aBndBox.CornerMax().Z()};
+ std::list<std::shared_ptr<GeomAPI_Pnt> > aResultPoints;
+ int aNum = 0;
+ for(int i = 0; i < 2; i++) {
+ for(int j = 0; j < 2; j++) {
+ for(int k = 0; k < 2; k++) {
+ std::shared_ptr<GeomAPI_Pnt> aPnt(new GeomAPI_Pnt(aXArr[i], aYArr[j], aZArr[k]));
+ aResultPoints.push_back(aPnt);
+ }
+ }
+ }
+
+ return aResultPoints;
+}
+
+//==================================================================================================
+std::shared_ptr<GeomAPI_Shape> GeomAlgoAPI_ShapeTools::faceToInfinitePlane(const std::shared_ptr<GeomAPI_Shape> theFace)
+{
+ if (!theFace.get())
+ return std::shared_ptr<GeomAPI_Shape>();
+
+ TopoDS_Face aPlaneFace = TopoDS::Face(theFace->impl<TopoDS_Shape>());
+ if (aPlaneFace.IsNull())
+ return std::shared_ptr<GeomAPI_Shape>();
+
+ Handle(Geom_Plane) aPlane = Handle(Geom_Plane)::DownCast(BRep_Tool::Surface(aPlaneFace));
+ if (aPlane.IsNull())
+ return std::shared_ptr<GeomAPI_Shape>();
+
+ // make an infinity face on the plane
+ TopoDS_Shape anInfiniteFace = BRepBuilderAPI_MakeFace(aPlane->Pln()).Shape();
+
+ std::shared_ptr<GeomAPI_Shape> aResult(new GeomAPI_Shape);
+ aResult->setImpl(new TopoDS_Shape(anInfiniteFace));
+ return aResult;
+}
+
+//==================================================================================================
+std::shared_ptr<GeomAPI_Face> GeomAlgoAPI_ShapeTools::fitPlaneToBox(const std::shared_ptr<GeomAPI_Shape> thePlane,
+ const std::list<std::shared_ptr<GeomAPI_Pnt> >& thePoints)
+{
+ std::shared_ptr<GeomAPI_Face> aResultFace;
+
+ if(!thePlane.get()) {
+ return aResultFace;
+ }
+
+ const TopoDS_Shape& aShape = thePlane->impl<TopoDS_Shape>();
+ if(aShape.ShapeType() != TopAbs_FACE) {
+ return aResultFace;
+ }
+
+ TopoDS_Face aFace = TopoDS::Face(aShape);
+ Handle(Geom_Surface) aSurf = BRep_Tool::Surface(aFace);
+ if(aSurf.IsNull()) {
+ return aResultFace;
+ }
+
+ GeomLib_IsPlanarSurface isPlanar(aSurf);
+ if(!isPlanar.IsPlanar()) {
+ return aResultFace;
+ }
+
+ if(thePoints.size() != 8) {
+ return aResultFace;
+ }
+
+ const gp_Pln& aFacePln = isPlanar.Plan();
+ Handle(Geom_Plane) aFacePlane = new Geom_Plane(aFacePln);
+ IntAna_Quadric aQuadric(aFacePln);
+ Standard_Real UMin, UMax, VMin, VMax;
+ UMin = UMax = VMin = VMax = 0;
+ for (std::list<std::shared_ptr<GeomAPI_Pnt> >::const_iterator aPointsIt = thePoints.begin(); aPointsIt != thePoints.end(); aPointsIt++) {
+ const gp_Pnt& aPnt = (*aPointsIt)->impl<gp_Pnt>();
+ gp_Lin aLin(aPnt, aFacePln.Axis().Direction());
+ IntAna_IntConicQuad anIntAna(aLin, aQuadric);
+ const gp_Pnt& aPntOnFace = anIntAna.Point(1);
+ Standard_Real aPntU(0), aPntV(0);
+ GeomLib_Tool::Parameters(aFacePlane, aPntOnFace, Precision::Confusion(), aPntU, aPntV);
+ if(aPntU < UMin) UMin = aPntU;
+ if(aPntU > UMax) UMax = aPntU;
+ if(aPntV < VMin) VMin = aPntV;
+ if(aPntV > VMax) VMax = aPntV;
+ }
+ aResultFace.reset(new GeomAPI_Face());
+ aResultFace->setImpl(new TopoDS_Face(BRepLib_MakeFace(aFacePln, UMin, UMax, VMin, VMax).Face()));
+
+ return aResultFace;
+}
+
+//==================================================================================================
+void GeomAlgoAPI_ShapeTools::findBounds(const std::shared_ptr<GeomAPI_Shape> theShape,
+ std::shared_ptr<GeomAPI_Vertex>& theV1,
+ std::shared_ptr<GeomAPI_Vertex>& theV2)
+{
+ if(!theShape.get()) {
+ std::shared_ptr<GeomAPI_Vertex> aVertex(new GeomAPI_Vertex);
+ aVertex->setImpl(new TopoDS_Vertex());
+ theV1 = aVertex;
+ theV2 = aVertex;
+ return;
+ }
+
+ const TopoDS_Shape& aShape = theShape->impl<TopoDS_Shape>();
+ TopoDS_Vertex aV1, aV2;
+ ShapeAnalysis::FindBounds(aShape, aV1, aV2);
+
+ std::shared_ptr<GeomAPI_Vertex> aGeomV1(new GeomAPI_Vertex()), aGeomV2(new GeomAPI_Vertex());
+ aGeomV1->setImpl(new TopoDS_Vertex(aV1));
+ aGeomV2->setImpl(new TopoDS_Vertex(aV2));
+ theV1 = aGeomV1;
+ theV2 = aGeomV2;
+}
+
+//==================================================================================================
+void GeomAlgoAPI_ShapeTools::makeFacesWithHoles(const std::shared_ptr<GeomAPI_Pnt> theOrigin,
+ const std::shared_ptr<GeomAPI_Dir> theDirection,
+ const ListOfShape& theWires,
+ ListOfShape& theFaces)
+{
+ BRepBuilderAPI_MakeFace aMKFace(gp_Pln(theOrigin->impl<gp_Pnt>(),
+ theDirection->impl<gp_Dir>()));
+ TopoDS_Face aFace = aMKFace.Face();
+
+ BRepAlgo_FaceRestrictor aFRestrictor;
+ aFRestrictor.Init(aFace, Standard_False, Standard_True);
+ for(ListOfShape::const_iterator anIt = theWires.cbegin();
+ anIt != theWires.cend();
+ ++anIt) {
+ TopoDS_Wire aWire = TopoDS::Wire((*anIt)->impl<TopoDS_Shape>());
+ aFRestrictor.Add(aWire);
+ }
+
+ aFRestrictor.Perform();
+
+ if(!aFRestrictor.IsDone()) {
+ return;
+ }
+
+ for(; aFRestrictor.More(); aFRestrictor.Next()) {
+ GeomShapePtr aShape(new GeomAPI_Shape());
+ aShape->setImpl(new TopoDS_Shape(aFRestrictor.Current()));
+ theFaces.push_back(aShape);
+ }
+}
+
+//==================================================================================================
+std::shared_ptr<GeomAPI_Pln> GeomAlgoAPI_ShapeTools::findPlane(const ListOfShape& theShapes)
+{
+ TopoDS_Compound aCompound;
+ BRep_Builder aBuilder;
+ aBuilder.MakeCompound(aCompound);
+
+ for(ListOfShape::const_iterator anIt = theShapes.cbegin(); anIt != theShapes.cend(); ++anIt) {
+ aBuilder.Add(aCompound, (*anIt)->impl<TopoDS_Shape>());
+ }
+ BRepBuilderAPI_FindPlane aFindPlane(aCompound);
+
+ if(aFindPlane.Found() != Standard_True) {
+ return std::shared_ptr<GeomAPI_Pln>();
+ }
+
+ Handle(Geom_Plane) aPlane = aFindPlane.Plane();
+ gp_Pnt aLoc = aPlane->Location();
+ gp_Dir aDir = aPlane->Axis().Direction();
+
+ std::shared_ptr<GeomAPI_Pnt> aGeomPnt(new GeomAPI_Pnt(aLoc.X(), aLoc.Y(), aLoc.Z()));
+ std::shared_ptr<GeomAPI_Dir> aGeomDir(new GeomAPI_Dir(aDir.X(), aDir.Y(), aDir.Z()));
+
+ std::shared_ptr<GeomAPI_Pln> aPln(new GeomAPI_Pln(aGeomPnt, aGeomDir));
+
+ return aPln;
+}
+
+//==================================================================================================
+bool GeomAlgoAPI_ShapeTools::isSubShapeInsideShape(const std::shared_ptr<GeomAPI_Shape> theSubShape,
+ const std::shared_ptr<GeomAPI_Shape> theBaseShape)
+{
+ if(!theSubShape.get() || !theBaseShape.get()) {
+ return false;
+ }
+
+ const TopoDS_Shape& aSubShape = theSubShape->impl<TopoDS_Shape>();
+ const TopoDS_Shape& aBaseShape = theBaseShape->impl<TopoDS_Shape>();
+
+ if(aSubShape.ShapeType() == TopAbs_VERTEX) {
+ // If sub-shape is a vertex check distance to shape. If it is <= Precision::Confusion() then OK.
+ BRepExtrema_DistShapeShape aDist(aBaseShape, aSubShape);
+ aDist.Perform();
+ if(!aDist.IsDone() || aDist.Value() > Precision::Confusion()) {
+ return false;
+ }
+ } else if (aSubShape.ShapeType() == TopAbs_EDGE) {
+ if(aBaseShape.ShapeType() == TopAbs_FACE) {
+ // Check that edge is on face surface.
+ TopoDS_Face aFace = TopoDS::Face(aBaseShape);
+ TopoDS_Edge anEdge = TopoDS::Edge(aSubShape);
+ BRepLib_CheckCurveOnSurface aCheck(anEdge, aFace);
+ aCheck.Perform();
+ if(!aCheck.IsDone() || aCheck.MaxDistance() > Precision::Confusion()) {
+ return false;
+ }
+
+ // Check intersections.
+ TopoDS_Vertex aV1, aV2;
+ ShapeAnalysis::FindBounds(anEdge, aV1, aV2);
+ gp_Pnt aPnt1 = BRep_Tool::Pnt(aV1);
+ gp_Pnt aPnt2 = BRep_Tool::Pnt(aV2);
+ for(TopExp_Explorer anExp(aBaseShape, TopAbs_EDGE); anExp.More(); anExp.Next()) {
+ const TopoDS_Shape& anEdgeOnFace = anExp.Current();
+ BRepExtrema_DistShapeShape aDist(anEdgeOnFace, anEdge);
+ aDist.Perform();
+ if(aDist.IsDone() && aDist.Value() <= Precision::Confusion()) {
+ // Edge intersect face bound. Check that it is not on edge begin or end.
+ for(Standard_Integer anIndex = 1; anIndex <= aDist.NbSolution(); ++anIndex) {
+ gp_Pnt aPntOnSubShape = aDist.PointOnShape2(anIndex);
+ if(aPntOnSubShape.Distance(aPnt1) > Precision::Confusion()
+ && aPntOnSubShape.Distance(aPnt2) > Precision::Confusion()) {
+ return false;
+ }
+ }
+ }
+ }
+
+ // No intersections found. Edge is inside or outside face. Check it.
+ BRepAdaptor_Curve aCurveAdaptor(anEdge);
+ gp_Pnt aPointToCheck = aCurveAdaptor.Value((aCurveAdaptor.FirstParameter() + aCurveAdaptor.LastParameter()) / 2.0);
+ Handle(Geom_Surface) aSurface = BRep_Tool::Surface(aFace);
+ ShapeAnalysis_Surface aSAS(aSurface);
+ gp_Pnt2d aPointOnFace = aSAS.ValueOfUV(aPointToCheck, Precision::Confusion());
+ BRepTopAdaptor_FClass2d aFClass2d(aFace, Precision::Confusion());
+ if(aFClass2d.Perform(aPointOnFace) == TopAbs_OUT) {
+ return false;
+ }
+
+ } else {
+ return false;