#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;
}