#include "GeoCommandMakeMatrix.h"
#include "Geometry/geometryData.h"
#include "Geometry/geometrySet.h"
#include <TopoDS_Shape.hxx>
#include <gp_Ax2.hxx>
#include <BRepBuilderAPI_Transform.hxx>
#include <TopoDS_Compound.hxx>
#include <BRep_Builder.hxx>
#include "Geometry/geometryParaMakeMatrix.h"
#include <QDebug>

namespace Command
{
	CommandMakeMatrix::CommandMakeMatrix(GUI::MainWindow *m, MainWidget::PreWindow *p)
		: GeoCommandBase(m, p)
	{
	}

	bool CommandMakeMatrix::execute()
	{
		bool success = false;
		const int count = _bodys.size();

		if (_selectLinear)
		{
			QMultiHash<Geometry::GeometrySet *, int>::iterator iter = _solidhash.begin();
			for (; iter != _solidhash.end(); ++iter)
			{
				Geometry::GeometrySet *set = iter.key();
				QList<int> indexList = _solidhash.values(set);
				TopoDS_Shape *shape = set->getShape(4, iter.value());

				TopoDS_Compound aRes;
				BRep_Builder aBuilder;
				aBuilder.MakeCompound(aRes);

				//获取vectors
				QList<double *> vectors;
				if (_selectDir2)
				{
					QList<double *> vecDir1List = getDir1Vector();
					if (vecDir1List.size() < 1)
						success = false;
					QList<double *> vecDir2List = getDir2Vector();
					if (vecDir2List.size() < 1)
						success = false;
					vectors = getVecSumlist(vecDir1List, vecDir2List);
				}
				else
				{
					vectors = getDir1Vector();
				}
				if (vectors.size() < 1)
					success = false;
				for (int i = 0; i < vectors.size(); ++i)
				{
					gp_Vec vec(vectors[i][0], vectors[i][1], vectors[i][2]);
					gp_Trsf aTrsf;
					aTrsf.SetTranslation(vec);
					BRepBuilderAPI_Transform aBRespTrsf(*shape, aTrsf, true);
					aBRespTrsf.Build();
					if (!aBRespTrsf.IsDone())
						continue;
					aBuilder.Add(aRes, aBRespTrsf.Shape());
				}
				success = true;
				TopoDS_Shape *mshape = new TopoDS_Shape;
				*mshape = aRes;
				QString name = QString("LinearMaxtrix-%1").arg(set->getName());
				Geometry::GeometrySet *newset = new Geometry::GeometrySet;
				newset->setName(name);
				newset->setShape(mshape);
				_geoData->appendGeometrySet(newset);

				Geometry::GeometryParaMatrix *para = new Geometry::GeometryParaMatrix;
				para->setOriSet(set);
				for (int k = 0; k < indexList.size(); k++)
				{
					para->appendBody(set, indexList[k]);
				}
				para->setCurrentIndex(0);
				para->setDirection1(_dir1);
				para->setReverse1(_reverse1);
				para->setDistance1(_dir1Distance);
				para->setCount1(_dir1Count);
				para->setShowDir2(_selectDir2);
				newset->setParameter(para);

				if (_selectDir2)
				{
					para->setDirection2(_dir2);
					para->setReverse2(_reverse2);
					para->setDistance2(_dir2Distance);
					para->setCount2(_dir2Count);
				}
				if (_isEdit)
				{
					_geoData->removeTopGeometrySet(_editSet);
					_releasenew = true;
					_releaseEdit = false;
				}
				emit showSet(newset);
				_resultHash.insert(newset, set);
			}
		}

		if (_selectWire)
		{
			gp_Pnt pt(_basicPoint[0], _basicPoint[1], _basicPoint[2]);
			getVecWire();
			gp_Dir vec(_axisdir[0], _axisdir[1], _axisdir[2]);

			gp_Ax1 ax;
			ax.SetLocation(pt);
			ax.SetDirection(vec);

			QMultiHash<Geometry::GeometrySet *, int>::iterator iter = _solidhash.begin();
			for (; iter != _solidhash.end(); ++iter)
			{
				Geometry::GeometrySet *set = iter.key();
				QList<int> indexList = _solidhash.values(set);
				TopoDS_Shape *shape = set->getShape(4, iter.value());
				TopoDS_Compound aRes;
				BRep_Builder aBuilder;
				aBuilder.MakeCompound(aRes);
				QList<double *> angleList = getAngleList();
				for (int i = 0; i < angleList.size(); ++i)
				{
					gp_Trsf aTrsf;
					aTrsf.SetRotation(ax, *angleList[i]);
					BRepBuilderAPI_Transform aBRespTrsf(*shape, aTrsf, true);
					aBRespTrsf.Build();
					if (!aBRespTrsf.IsDone())
						continue;
					aBuilder.Add(aRes, aBRespTrsf.Shape());
					if (aRes.IsNull())
						continue;
				}
				success = true;
				TopoDS_Shape *mshape = new TopoDS_Shape;
				*mshape = aRes;
				QString name = QString("WireMaxtrix-%1").arg(set->getName());
				Geometry::GeometrySet *newset = new Geometry::GeometrySet;
				newset->setName(name);
				newset->setShape(mshape);
				_geoData->appendGeometrySet(newset);
				Geometry::GeometryParaMatrix *para = new Geometry::GeometryParaMatrix;
				para->setOriSet(set);
				for (int k = 0; k < indexList.size(); k++)
				{
					para->appendBody(set, indexList[k]);
				}
				para->setCurrentIndex(1);
				para->setAxis(_basicPoint);
				para->setAxisDir(_axisdir);
				para->setAxisCount(_wireCount);
				para->setAngle(_degree);
				newset->setParameter(para);
				if (_isEdit)
				{
					_geoData->removeTopGeometrySet(_editSet);
				}
				emit showSet(newset);
				_resultHash.insert(newset, set);
			}
		}
		emit updateGeoTree();
		GeoCommandBase::execute();
		return success;
	}

	void CommandMakeMatrix::undo()
	{
		if (_isEdit)
		{
			Geometry::GeometryModelParaBase *pm = _editSet->getParameter();
			Geometry::GeometryParaMatrix *p = dynamic_cast<Geometry::GeometryParaMatrix *>(pm);
			if (p == nullptr)
				return;
			Geometry::GeometrySet *ori = p->getOriSet();
			if (ori == nullptr)
				return;
			auto newset = _resultHash.key(ori);
			if (newset == nullptr)
				return;
			_geoData->replaceSet(_editSet, newset);

			newset->removeSubSet(ori);
			_editSet->removeSubSet(ori);
			_geoData->removeTopGeometrySet(ori);
			_geoData->appendGeometrySet(ori);
			emit showSet(ori);
			emit showSet(_editSet);
			emit removeDisplayActor(newset);

			emit updateGeoTree();
			_releasenew = true;
			_releaseEdit = false;
			return;
		}

		QList<Geometry::GeometrySet *> geoList = _resultHash.keys();
		for (int i = 0; i < geoList.size(); ++i)
		{
			Geometry::GeometrySet *set = geoList.at(i);
			_geoData->removeTopGeometrySet(set);
			emit removeDisplayActor(set);
		}
		emit updateGeoTree();
	}

	void CommandMakeMatrix::redo()
	{
		if (_isEdit)
		{
			Geometry::GeometryModelParaBase *pm = _editSet->getParameter();
			Geometry::GeometryParaMatrix *p = dynamic_cast<Geometry::GeometryParaMatrix *>(pm);
			if (p == nullptr)
				return;
			Geometry::GeometrySet *ori = p->getOriSet();
			if (ori == nullptr)
				return;
			auto newset = _resultHash.key(ori);
			if (newset == nullptr)
				return;
			_geoData->replaceSet(newset, _editSet);

			newset->removeSubSet(ori);
			_editSet->removeSubSet(ori);
			_geoData->removeTopGeometrySet(ori);
			_geoData->appendGeometrySet(ori);
			emit showSet(ori);
			emit showSet(newset);
			emit removeDisplayActor(_editSet);
			emit updateGeoTree();
			_releasenew = false;
			_releaseEdit = true;
			return;
		}

		QList<Geometry::GeometrySet *> geoList = _resultHash.keys();
		for (int i = 0; i < geoList.size(); ++i)
		{
			Geometry::GeometrySet *set = geoList.at(i);
			_geoData->appendGeometrySet(set);
			emit showSet(set);
		}
		emit updateGeoTree();
	}

	void CommandMakeMatrix::releaseResult()
	{
		QList<Geometry::GeometrySet *> geoList = _resultHash.keys();
		for (int i = 0; i < geoList.size(); ++i)
		{
			Geometry::GeometrySet *set = geoList.at(i);
			delete set;
		}
	}

	void CommandMakeMatrix::setBodys(QMultiHash<Geometry::GeometrySet *, int> b)
	{
		_solidhash = b;
	}
	void CommandMakeMatrix::setSelectLinear(bool s)
	{
		_selectLinear = s;
	}
	void CommandMakeMatrix::setSelectWire(bool s)
	{
		_selectWire = s;
	}

	void CommandMakeMatrix::setOptionIndex(int i)
	{
		if (i == 0)
		{
			_selectLinear = true;
			_selectWire = false;
		}
		else
		{
			_selectLinear = false;
			_selectWire = true;
		}
	}

	void CommandMakeMatrix::setBasicPoint(double *bp)
	{
		for (int i = 0; i < 3; ++i)
		{
			_basicPoint[i] = bp[i];
		}
	}

	void CommandMakeMatrix::setAxisDir(double *dir)
	{
		for (int i = 0; i < 3; i++)
		{
			_axisdir[i] = dir[i];
		}
	}

	void CommandMakeMatrix::setDir1(double *dir)
	{
		_dir1[0] = dir[0];
		_dir1[1] = dir[1];
		_dir1[2] = dir[2];
	}

	void CommandMakeMatrix::setReverse1(bool s)
	{
		_reverse1 = s;
	}

	void CommandMakeMatrix::setDir1Distance(double d)
	{
		_dir1Distance = d;
	}

	void CommandMakeMatrix::setDir1Count(int count)
	{
		_dir1Count = count;
	}
	void CommandMakeMatrix::setDir2IsChecked(bool k)
	{
		_selectDir2 = k;
	}
	void CommandMakeMatrix::setDir2(double *dir)
	{
		_dir2[0] = dir[0];
		_dir2[1] = dir[1];
		_dir2[2] = dir[2];
	}

	void CommandMakeMatrix::setReverse2(bool s)
	{
		_reverse2 = s;
	}

	void CommandMakeMatrix::setDir2Distance(double d)
	{
		_dir2Distance = d;
	}

	void CommandMakeMatrix::setDir2Count(int count)
	{
		_dir2Count = count;
	}

	void CommandMakeMatrix::setWireCount(int s)
	{
		_wireCount = s;
	}

	void CommandMakeMatrix::setDegree(double d)
	{
		_degree = d;
	}

	void CommandMakeMatrix::setWireRevers(bool s)
	{
		_reversewire = s;
	}

	void CommandMakeMatrix::getVecWire()
	{
		double mod = _axisdir[0] * _axisdir[0] + _axisdir[1] * _axisdir[1] + _axisdir[2] * _axisdir[2];
		if (mod < 0.000001)
			return;

		if (_reversewire)
			for (int i = 0; i < 3; ++i)
				_axisdir[i] *= -1;
	}

	QList<double *> CommandMakeMatrix::getAngleList()
	{
		QList<double *> angleList{};
		for (int i = 1; i < _wireCount; ++i)
		{
			double temp = _degree * i;
			double *angle = new double;
			*angle = temp * PI / 180.00;
			angleList.append(angle);
		}
		return angleList;
	}

	QList<double *> CommandMakeMatrix::getDir1Vector()
	{

		QList<double *> vectors{};
		if (_reverse1)
		{
			for (int i = 0; i < 3; ++i)
				_dir1[i] *= -1;
		}
		double mod = sqrt(_dir1[0] * _dir1[0] + _dir1[1] * _dir1[1] + _dir1[2] * _dir1[2]);
		for (int i = 1; i < _dir1Count; ++i)
		{
			double *veccopy = new double[3]{};
			double length = i * _dir1Distance;
			double fac = length / mod;
			for (int i = 0; i < 3; ++i)
			{
				veccopy[i] = fac * _dir1[i];
			}
			vectors.append(veccopy);
		}
		return vectors;
	}

	QList<double *> CommandMakeMatrix::getDir2Vector()
	{

		QList<double *> vectors{};
		if (_reverse2)
		{
			for (int i = 0; i < 3; ++i)
				_dir2[i] *= -1;
		}
		double mod = sqrt(_dir2[0] * _dir2[0] + _dir2[1] * _dir2[1] + _dir2[2] * _dir2[2]);
		for (int i = 1; i < _dir2Count; ++i)
		{
			double *veccopy = new double[3]{};
			double length = i * _dir2Distance;
			double fac = length / mod;
			for (int i = 0; i < 3; ++i)
			{
				veccopy[i] = fac * _dir2[i];
			}
			vectors.append(veccopy);
		}
		return vectors;
	}

	QList<double *> CommandMakeMatrix::getVecSumlist(QList<double *> dir1list, QList<double *> dir2list)
	{
		QList<double *> sumList{};
		for (int i = 0; i < dir1list.size(); ++i)
		{
			for (int j = 0; j < dir2list.size(); ++j)
			{
				double *vecTmep = new double[3]{};
				vecTmep[0] = (dir1list[i][0] + dir2list[j][0]);
				vecTmep[1] = (dir1list[i][1] + dir2list[j][1]);
				vecTmep[2] = (dir1list[i][2] + dir2list[j][2]);
				sumList.append(vecTmep);
			}
		}
		sumList.append(dir1list);
		sumList.append(dir2list);
		return sumList;
	}

}