459 lines
9.7 KiB
C++
459 lines
9.7 KiB
C++
|
#include "Stdafx.h"
|
|||
|
|
#include "SolidBool.h"
|
|||
|
|
#include "CutSurfaceAlgo.h"
|
|||
|
|
#include "BRepClass3d_SolidClassifier.hxx"
|
|||
|
|
#include "OCCLib.h"
|
|||
|
|
//#include "BOPTools_DSFiller.hxx" // XUEFENG DELETE 202009
|
|||
|
|
#include "BOPAlgo_PaveFiller.hxx" // XUEFENG ADDED 202009
|
|||
|
|
#include "BRepAlgoAPI_Cut.hxx"
|
|||
|
|
#include "BRepAlgoAPI_Fuse.hxx"
|
|||
|
|
#include "BRepAlgoAPI_Common.hxx"
|
|||
|
|
|
|||
|
|
|
|||
|
|
SolidBool::SolidBool(void)
|
|||
|
|
{
|
|||
|
|
isDone = false;
|
|||
|
|
isInit = false;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
SolidBool::SolidBool( TopoDS_Solid solid1, TopoDS_Solid solid2, BoolType type )
|
|||
|
|
{
|
|||
|
|
Init(solid1, solid2, type);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
SolidBool::~SolidBool(void)
|
|||
|
|
{
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void SolidBool::Init( TopoDS_Solid solid1, TopoDS_Solid solid2, BoolType type )
|
|||
|
|
{
|
|||
|
|
this->solid1 = solid1;
|
|||
|
|
this->solid2 = solid2;
|
|||
|
|
this->type = type;
|
|||
|
|
isInit = true;
|
|||
|
|
isDone = false;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void SolidBool::Perform()
|
|||
|
|
{
|
|||
|
|
//////////////////////////////////////////////////
|
|||
|
|
//
|
|||
|
|
//BOPTools_DSFiller aDF; // XUEFENG DELETE 202009
|
|||
|
|
BOPAlgo_PaveFiller aDF; // XUEFENG ADDED 202009
|
|||
|
|
|
|||
|
|
if(IsReversed(solid1))
|
|||
|
|
{
|
|||
|
|
solid1.Reverse();
|
|||
|
|
}
|
|||
|
|
if(IsReversed(solid2))
|
|||
|
|
{
|
|||
|
|
solid2.Reverse();
|
|||
|
|
}
|
|||
|
|
//aDF.SetShapes (solid1, solid2); // XUEFENG DELETE 202009 6.3.0
|
|||
|
|
|
|||
|
|
// XUEFENG ADDED 202009
|
|||
|
|
// OCC 7.1.0
|
|||
|
|
//BOPCol_ListOfShape aLS; // NOT EXIST IN 7.6.0
|
|||
|
|
TopTools_ListOfShape aLS; // OCC 7.6.0
|
|||
|
|
aLS.Append(solid1);
|
|||
|
|
aLS.Append(solid2);
|
|||
|
|
aDF.SetArguments(aLS);
|
|||
|
|
|
|||
|
|
/* // XUEFENG DELETE 202009 6.3.0
|
|||
|
|
if (!aDF.IsDone())
|
|||
|
|
{
|
|||
|
|
// ... some error handler
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
*/
|
|||
|
|
|
|||
|
|
aDF.Perform();
|
|||
|
|
|
|||
|
|
//BRepAlgoAPI_Section fuse1(solid1 ,solid2, aDF);
|
|||
|
|
//if(!fuse1.IsDone())
|
|||
|
|
//{
|
|||
|
|
// this->result=fuse1.Shape();
|
|||
|
|
// isDone = true;
|
|||
|
|
//}
|
|||
|
|
|
|||
|
|
switch(type)
|
|||
|
|
{
|
|||
|
|
case 0://并
|
|||
|
|
{
|
|||
|
|
BRepAlgoAPI_Fuse fuse(solid1 ,solid2, aDF);
|
|||
|
|
if(!fuse.IsDone())
|
|||
|
|
{
|
|||
|
|
this->result=fuse.Shape();
|
|||
|
|
isDone = true;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
break;
|
|||
|
|
case 1:
|
|||
|
|
{
|
|||
|
|
BRepAlgoAPI_Cut cut(solid1 ,solid2, aDF);
|
|||
|
|
if(!cut.IsDone())
|
|||
|
|
{
|
|||
|
|
this->result=cut.Shape();
|
|||
|
|
isDone = true;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
break;
|
|||
|
|
case 2://交
|
|||
|
|
{
|
|||
|
|
BRepAlgoAPI_Common common(solid1 ,solid2, aDF);
|
|||
|
|
if(common.IsDone())
|
|||
|
|
{
|
|||
|
|
this->result=common.Shape();
|
|||
|
|
isDone = true;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
break;
|
|||
|
|
default:
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//void SolidBool::Perform()
|
|||
|
|
//{
|
|||
|
|
// if(!isInit)
|
|||
|
|
// {
|
|||
|
|
// return;
|
|||
|
|
// }
|
|||
|
|
//
|
|||
|
|
// TopoDS_Shape TopoShape;
|
|||
|
|
// TopoDS_Solid solid1,solid2,solidResult;
|
|||
|
|
// BRep_Builder builder;
|
|||
|
|
// BRepOffsetAPI_Sewing sew;
|
|||
|
|
// vector<TopoDS_Face> faceIn1,faceIn2,faceOut1,faceOut2, faceOn12,faceOn21;
|
|||
|
|
// vector<int> onID;
|
|||
|
|
// int count = 0;
|
|||
|
|
//
|
|||
|
|
// vector<TopoDS_Shape> faceSet;
|
|||
|
|
//
|
|||
|
|
// clock_t start,finish; //typedef long clock_t;
|
|||
|
|
// double totaltime;
|
|||
|
|
// start=clock(); //clock():确定处理器当前时间
|
|||
|
|
//
|
|||
|
|
// SplitShell(this->solid1,this->solid2, faceIn1,faceOut1,faceOn12);
|
|||
|
|
//
|
|||
|
|
// finish=clock();
|
|||
|
|
// totaltime=(double)(finish-start)/CLOCKS_PER_SEC;
|
|||
|
|
// cout << "+++++++++++++++++++++++++++++++切船壳："<<totaltime<<"s"<<endl;
|
|||
|
|
//
|
|||
|
|
// start=clock(); //clock():确定处理器当前时间
|
|||
|
|
//
|
|||
|
|
// SplitShell(this->solid2, this->solid1, faceIn2, faceOut2,faceOn21);
|
|||
|
|
//
|
|||
|
|
// finish=clock();
|
|||
|
|
// totaltime=(double)(finish-start)/CLOCKS_PER_SEC;
|
|||
|
|
// cout << "+++++++++++++++++++++++++++++++切体："<<totaltime<<"s"<<endl;
|
|||
|
|
//
|
|||
|
|
//
|
|||
|
|
// builder.MakeSolid(solidResult);
|
|||
|
|
//
|
|||
|
|
// switch(type)
|
|||
|
|
// {
|
|||
|
|
// case 0://并
|
|||
|
|
// for(int i = 0; i < faceOut1.size(); i++)
|
|||
|
|
// {
|
|||
|
|
// faceSet.push_back(faceOut1[i]);
|
|||
|
|
// }
|
|||
|
|
// for(int i = 0; i < faceOut2.size(); i++)
|
|||
|
|
// {
|
|||
|
|
// faceSet.push_back(faceOut2[i]);
|
|||
|
|
// }
|
|||
|
|
// if(faceOut2.size() == 0)
|
|||
|
|
// {
|
|||
|
|
// for(int i = 0; i < faceOn21.size(); i++)
|
|||
|
|
// {
|
|||
|
|
// faceSet.push_back(faceOn21[i]);
|
|||
|
|
// onID.push_back(faceSet.size() - 1);
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
//
|
|||
|
|
// if(faceOut1.size() == 0)
|
|||
|
|
// {
|
|||
|
|
// for(int i = 0; i < faceOn12.size(); i++)
|
|||
|
|
// {
|
|||
|
|
// faceSet.push_back(faceOn12[i]);
|
|||
|
|
// onID.push_back(faceSet.size() - 1);
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
//
|
|||
|
|
// break;
|
|||
|
|
// case 1://差
|
|||
|
|
// for(int i = 0; i < faceOut1.size(); i++)
|
|||
|
|
// {
|
|||
|
|
// faceSet.push_back(faceOut1[i]);
|
|||
|
|
// }
|
|||
|
|
// for(int i = 0; i < faceIn2.size(); i++)
|
|||
|
|
// {
|
|||
|
|
// faceSet.push_back(faceIn2[i]);
|
|||
|
|
// }
|
|||
|
|
// if(faceIn2.size() == 0)
|
|||
|
|
// {
|
|||
|
|
// for(int i = 0; i < faceOn21.size(); i++)
|
|||
|
|
// {
|
|||
|
|
// faceSet.push_back(faceOn21[i]);
|
|||
|
|
// onID.push_back(faceSet.size() - 1);
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// break;
|
|||
|
|
// case 2://交
|
|||
|
|
// for(int i = 0; i < faceIn1.size(); i++)
|
|||
|
|
// {
|
|||
|
|
// faceSet.push_back(faceIn1[i]);
|
|||
|
|
// }
|
|||
|
|
// for(int i = 0; i < faceIn2.size(); i++)
|
|||
|
|
// {
|
|||
|
|
// faceSet.push_back(faceIn2[i]);
|
|||
|
|
// }
|
|||
|
|
// if(faceOut1.size() ==0 && faceOut2.size() == 0)
|
|||
|
|
// {
|
|||
|
|
// for(int i = 0; i < faceOn21.size(); i++)
|
|||
|
|
// {
|
|||
|
|
// faceSet.push_back(faceOn21[i]);
|
|||
|
|
// onID.push_back(faceSet.size() - 1);
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// else if(faceIn1.size() > 0 || faceIn2.size() > 0)
|
|||
|
|
// {
|
|||
|
|
// for(int i = 0; i < faceOn21.size(); i++)
|
|||
|
|
// {
|
|||
|
|
// faceSet.push_back(faceOn21[i]);
|
|||
|
|
// onID.push_back(faceSet.size() - 1);
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// break;
|
|||
|
|
// default:
|
|||
|
|
// break;
|
|||
|
|
// }
|
|||
|
|
//
|
|||
|
|
// start=clock();
|
|||
|
|
//
|
|||
|
|
// OCCLib occLib;
|
|||
|
|
// faceSet = SolidSurfaceClear(faceSet, onID);
|
|||
|
|
//
|
|||
|
|
// finish=clock();
|
|||
|
|
// totaltime=(double)(finish-start)/CLOCKS_PER_SEC;
|
|||
|
|
// cout << "+++++++++++++++++++++++++++++++清理面("<<faceSet.size()<<")："<<totaltime<<"s"<<endl;
|
|||
|
|
//
|
|||
|
|
//
|
|||
|
|
// start=clock();
|
|||
|
|
// TopoDS_Shell shell = occLib.SewShell(faceSet);
|
|||
|
|
//
|
|||
|
|
// finish=clock();
|
|||
|
|
// totaltime=(double)(finish-start)/CLOCKS_PER_SEC;
|
|||
|
|
// cout << "+++++++++++++++++++++++++++++++缝合："<<totaltime<<"s"<<endl;
|
|||
|
|
//
|
|||
|
|
// this->result = BRepBuilderAPI_MakeSolid(shell).Solid();
|
|||
|
|
// isDone = true;
|
|||
|
|
//}
|
|||
|
|
|
|||
|
|
TopoDS_Shape SolidBool::SplitShell(TopoDS_Shape& solid1,TopoDS_Shape& solid2, vector<TopoDS_Face>& faceIn, vector<TopoDS_Face>& faceOut, vector<TopoDS_Face>& faceOn)
|
|||
|
|
{
|
|||
|
|
TopoDS_Shape TopoShape,TopoTemp;
|
|||
|
|
TopoDS_Shell TopoShell;
|
|||
|
|
TopExp_Explorer ex,ex1;
|
|||
|
|
//BRepOffsetAPI_Sewing sew;
|
|||
|
|
BRepClass3d_SolidClassifier solidClassifier(TopoDS::Solid(solid2));
|
|||
|
|
int count = 0;
|
|||
|
|
|
|||
|
|
BRep_Builder b;
|
|||
|
|
b.MakeShell(TopoShell);
|
|||
|
|
|
|||
|
|
double areas = 0.0;
|
|||
|
|
vector<gp_Pnt> pntSet;
|
|||
|
|
vector<double> areaSet;
|
|||
|
|
|
|||
|
|
Bnd_Box shellBox;
|
|||
|
|
|
|||
|
|
static int hhh = 0;
|
|||
|
|
hhh++;
|
|||
|
|
//if(3==hhh)
|
|||
|
|
//{
|
|||
|
|
// throw solid2;
|
|||
|
|
//}
|
|||
|
|
|
|||
|
|
bool isSurf = (solid2.ShapeType() == TopAbs_FACE || solid2.ShapeType() == TopAbs_SHELL);
|
|||
|
|
|
|||
|
|
for(TopExp_Explorer ex(solid2,TopAbs_FACE); ex.More(); ex.Next())
|
|||
|
|
{
|
|||
|
|
TopoDS_Face face = TopoDS::Face(ex.Current());
|
|||
|
|
GProp_GProps System_;
|
|||
|
|
gp_Pnt faceCenter;
|
|||
|
|
BRepGProp::SurfaceProperties(face,System_);
|
|||
|
|
faceCenter = System_.CentreOfMass();
|
|||
|
|
double area = System_.Mass();
|
|||
|
|
|
|||
|
|
pntSet.push_back(faceCenter);
|
|||
|
|
areaSet.push_back(area);
|
|||
|
|
areas += area;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
gp_Pnt solidCenter(0,0,0);
|
|||
|
|
for(int i = 0; i < pntSet.size(); i++)
|
|||
|
|
{
|
|||
|
|
gp_Pnt g1 = pntSet[i];
|
|||
|
|
|
|||
|
|
solidCenter.SetX(solidCenter.X() + g1.X() * areaSet[i] / areas);
|
|||
|
|
solidCenter.SetY(solidCenter.Y() + g1.Y() * areaSet[i] / areas);
|
|||
|
|
solidCenter.SetZ(solidCenter.Z() + g1.Z() * areaSet[i] / areas);
|
|||
|
|
}
|
|||
|
|
//return TopoTemp;
|
|||
|
|
|
|||
|
|
|
|||
|
|
for(TopExp_Explorer ex(solid2,TopAbs_FACE); ex.More(); ex.Next())
|
|||
|
|
{
|
|||
|
|
b.Add(TopoShell,TopoDS::Face(ex.Current()));
|
|||
|
|
}
|
|||
|
|
//throw TopoShell;
|
|||
|
|
TopoTemp = TopoShell;
|
|||
|
|
TopoShape = TopoTemp;
|
|||
|
|
|
|||
|
|
for(TopExp_Explorer ex(TopoTemp,TopAbs_VERTEX); ex.More(); ex.Next())
|
|||
|
|
{
|
|||
|
|
gp_Pnt p = BRep_Tool::Pnt(TopoDS::Vertex(ex.Current()));
|
|||
|
|
shellBox.Add(p);
|
|||
|
|
}
|
|||
|
|
//return TopoTemp;
|
|||
|
|
|
|||
|
|
vector<TopoDS_Shell> shellSet;
|
|||
|
|
CutSurfaceAlgo cutSurface(solid1, TopoTemp);
|
|||
|
|
cutSurface.TrimSurfaceTranslateInsec(shellSet);
|
|||
|
|
|
|||
|
|
vector<TopoDS_Face> faceSet;
|
|||
|
|
for(int i = 0; i < shellSet.size(); i++)
|
|||
|
|
{
|
|||
|
|
TopoDS_Shell shelltmp = shellSet[i];
|
|||
|
|
|
|||
|
|
for(TopExp_Explorer ex(shelltmp, TopAbs_FACE); ex.More(); ex.Next())
|
|||
|
|
{
|
|||
|
|
faceSet.push_back(TopoDS::Face(ex.Current()));
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
for(int j = 0; j < faceSet.size(); j++)
|
|||
|
|
{
|
|||
|
|
TopoDS_Face facetmp = faceSet[j];
|
|||
|
|
|
|||
|
|
vector<gp_Pnt> vs,vs_center;
|
|||
|
|
GProp_GProps System;
|
|||
|
|
gp_Pnt faceCenter;
|
|||
|
|
BRepGProp::SurfaceProperties(facetmp,System);
|
|||
|
|
faceCenter = System.CentreOfMass();
|
|||
|
|
|
|||
|
|
|
|||
|
|
for(TopExp_Explorer ex_f(facetmp, TopAbs_EDGE); ex_f.More(); ex_f.Next())
|
|||
|
|
{
|
|||
|
|
TopoDS_Edge edge = TopoDS::Edge(ex_f.Current());
|
|||
|
|
gp_Pnt p1,p2;
|
|||
|
|
GetEdgeStartEndPoint(edge, p1, p2);
|
|||
|
|
vs.push_back(p1);
|
|||
|
|
vs.push_back(p2);
|
|||
|
|
|
|||
|
|
//for(TopExp_Explorer e_t(solid1, TopAbs_EDGE);e_t.More(); e_t.Next())
|
|||
|
|
//{
|
|||
|
|
// TopoDS_Edge edgeTmp = TopoDS::Edge(e_t.Current());
|
|||
|
|
// if(CheckTwoEdgeOverlapByLinePointProject(edgeTmp, edge))
|
|||
|
|
// {
|
|||
|
|
// double dl,df;
|
|||
|
|
// Handle(Geom_Curve) cv = BRep_Tool::Curve(edge, df,dl);
|
|||
|
|
// vs_center.push_back(cv->Value((df+dl) / 2));
|
|||
|
|
// break;
|
|||
|
|
// }
|
|||
|
|
//}
|
|||
|
|
|
|||
|
|
//double dl,df;
|
|||
|
|
//Handle(Geom_Curve) cv = BRep_Tool::Curve(edge, df,dl);
|
|||
|
|
//vs_center.push_back(cv->Value((df+dl) / 2));
|
|||
|
|
|
|||
|
|
gp_Pnt p((p1.X() + p2.X()) / 2,(p1.Y() + p2.Y()) / 2,(p1.Z() + p2.Z()) / 2);
|
|||
|
|
|
|||
|
|
BRepExtrema_DistShapeShape inter(BRepBuilderAPI_MakeVertex(p),edge);
|
|||
|
|
inter.Perform();
|
|||
|
|
|
|||
|
|
gp_Pnt center = inter.PointOnShape2(1);
|
|||
|
|
vs_center.push_back(center);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
bool isOn = true;
|
|||
|
|
bool isIn = false;
|
|||
|
|
int i = 0;
|
|||
|
|
|
|||
|
|
//isIn = !isSurf;
|
|||
|
|
|
|||
|
|
for(i = 0; i < vs.size(); i++)
|
|||
|
|
{
|
|||
|
|
TopoDS_Vertex v = BRepBuilderAPI_MakeVertex(vs[i]);
|
|||
|
|
if(isOn)
|
|||
|
|
{
|
|||
|
|
BRepExtrema_DistShapeShape inter(v,TopoTemp);
|
|||
|
|
inter.Perform();
|
|||
|
|
|
|||
|
|
if(inter.Value() < Precision::Confusion()*100)
|
|||
|
|
{
|
|||
|
|
continue;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
isOn = false;
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if(isOn)
|
|||
|
|
{
|
|||
|
|
BRepExtrema_DistShapeShape inter(BRepBuilderAPI_MakeVertex(faceCenter).Vertex(),TopoTemp);
|
|||
|
|
inter.Perform();
|
|||
|
|
if(inter.Value() > Precision::Confusion()*100)
|
|||
|
|
{
|
|||
|
|
isOn = false;
|
|||
|
|
//isIn = true;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if(!isOn)
|
|||
|
|
{
|
|||
|
|
isIn = true;
|
|||
|
|
for(int i = 0; i < vs_center.size(); i++)
|
|||
|
|
{
|
|||
|
|
solidClassifier.Perform(vs_center[i], 1E-5) ;
|
|||
|
|
TopAbs_State state = solidClassifier.State() ;
|
|||
|
|
if(state == TopAbs_IN || state == TopAbs_UNKNOWN)
|
|||
|
|
{
|
|||
|
|
isIn = false;
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
if(isOn)
|
|||
|
|
{
|
|||
|
|
faceOn.push_back(facetmp);
|
|||
|
|
}
|
|||
|
|
else if(isIn)
|
|||
|
|
{
|
|||
|
|
faceIn.push_back(facetmp);
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
faceOut.push_back(facetmp);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return TopoShape;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
TopoDS_Shape SolidBool::GetResult()
|
|||
|
|
{
|
|||
|
|
TopoDS_Shape shape;
|
|||
|
|
if(isDone)
|
|||
|
|
{
|
|||
|
|
shape = this->result;
|
|||
|
|
}
|
|||
|
|
return shape;
|
|||
|
|
}
|