#include "autofill.h"
#include "tregion.h"
#include "tgeometry.h"
#include "tstroke.h"
#include "toonz4.6/tmacro.h"
#include <QMap>
#include <QPair>
#include <QList>

namespace
{

#define BORDER_TOO 1
#define NO_BORDER 0
#define DIM_TRESH 0.00005
#define AMB_TRESH 130000
#define MIN_SIZE 20

//==============================================================================================

struct Region {
	double m_area, m_perimeter;
	TPointD m_barycentre;
	TDimensionD m_size;
	int m_match, m_styleId;
	TRegion *m_region;

	Region()
		: m_area(0), m_perimeter(0), m_barycentre(0, 0), m_size(0, 0), m_match(-1), m_styleId(0), m_region(0)
	{
	}
};

struct MatchingProbs {
	int m_from, m_to;
	int m_perimeterProb, m_areaProb, m_barycenterProb;
	bool m_overlappingArea, m_matched;

	MatchingProbs()
		: m_from(0), m_to(0), m_perimeterProb(0), m_areaProb(0), m_barycenterProb(0), m_overlappingArea(false), m_matched(false)
	{
	}
};

typedef QMap<int, Region> RegionDataList;

static RegionDataList regionsReference, regionsWork;
static TPointD referenceB(0, 0);
static TPointD workB(0, 0);

//==============================================================================================

class AreasAndPerimeterFormula : public TRegionFeatureFormula
{
	double m_signedArea, m_perimeter;

public:
	AreasAndPerimeterFormula()
		: m_signedArea(0), m_perimeter(0)
	{
	}

	~AreasAndPerimeterFormula()
	{
	}

	void update(const TPointD &p1, const TPointD &p2)
	{
		m_perimeter += norm(p2 - p1);
		m_signedArea += ((p1.x * p2.y) - (p2.x * p1.y)) * 0.5;
	}

	double getPerimeter() { return m_perimeter; }
	double getSignedArea() { return m_signedArea; }
	double getArea() { return fabs(m_signedArea); }
};

//---------------------------------------------------------------------------------------------

class CentroidFormula : public TRegionFeatureFormula
{
	TPointD m_centroid;
	double m_signedArea;

public:
	CentroidFormula()
		: m_centroid(), m_signedArea(0)
	{
	}

	~CentroidFormula()
	{
	}

	void update(const TPointD &p1, const TPointD &p2)
	{
		double factor = ((p1.x * p2.y) - (p2.x * p1.y));
		m_centroid.x += (p1.x + p2.x) * factor;
		m_centroid.y += (p1.y + p2.y) * factor;
	}

	void setSignedArea(double signedArea) { m_signedArea = signedArea; }
	TPointD getCentroid() { return (1 / (6 * m_signedArea)) * m_centroid; }
};

//---------------------------------------------------------------------------------------------

int match(std::vector<MatchingProbs> &probsVector, int &from, int &to)
{
	int i = 0, maxProb = 0;
	bool overlappingArea = false;
	std::vector<MatchingProbs>::iterator it, matchedProbs;
	for (it = probsVector.begin(); it != probsVector.end(); it++) {
		MatchingProbs probs = *it;
		if (probs.m_matched)
			continue;
		int probValue = probs.m_areaProb * probs.m_barycenterProb * probs.m_perimeterProb;
		if ((!overlappingArea && (maxProb < probValue || probs.m_overlappingArea)) ||
			(overlappingArea && maxProb < probValue && probs.m_overlappingArea)) {
			overlappingArea = probs.m_overlappingArea;
			maxProb = probValue;
			from = probs.m_from;
			to = probs.m_to;
			matchedProbs = it;
		}
	}
	if (maxProb)
		matchedProbs->m_matched = true;
	return maxProb;
}

//---------------------------------------------------------------------------------------------

void assignProbs(std::vector<MatchingProbs> &probVector, const Region &reference, const Region &work,
				 int from, int to)
{
	double delta_posx1, delta_posy1, delta_posx2, delta_posy2;
	int delta_area, delta_per;
	double delta_pos, delta_pos_max;

	MatchingProbs probs;
	probs.m_from = from;
	probs.m_to = to;

	TRegion *refRegion = reference.m_region;
	TRegion *workRegion = work.m_region;
	probs.m_overlappingArea = refRegion->getBBox().overlaps(workRegion->getBBox());

	delta_posx1 = reference.m_barycentre.x / reference.m_area - referenceB.x;
	delta_posy1 = reference.m_barycentre.y / reference.m_area - referenceB.y;

	delta_posx2 = work.m_barycentre.x / work.m_area - workB.x;
	delta_posy2 = work.m_barycentre.y / work.m_area - workB.y;

	// Cosi' calcolo il modulo della differenza

	delta_pos =
		sqrt((delta_posx2 - delta_posx1) * (delta_posx2 - delta_posx1) +
			 (delta_posy2 - delta_posy1) * (delta_posy2 - delta_posy1));
	delta_pos_max = sqrt((double)(work.m_size.lx * work.m_size.lx + work.m_size.ly * work.m_size.ly));

	probs.m_barycenterProb = tround(1000 * (1 - (delta_pos / delta_pos_max)));

	delta_area = abs(reference.m_area - work.m_area);

	probs.m_areaProb = tround(1000 * (1 - ((double)delta_area / (reference.m_area + work.m_area))));

	delta_per = abs(reference.m_perimeter - work.m_perimeter);
	probs.m_perimeterProb = tround(1000 * (1 - ((double)delta_per / (reference.m_perimeter + work.m_perimeter))));
	probVector.push_back(probs);
}

//----------------------------------------------------------------------------------------------

void scanRegion(TRegion *reg, int regionIndex, RegionDataList &rlst, const TRectD &selectingRect)
{
	assert(!rlst.contains(regionIndex));
	if (!selectingRect.contains(reg->getBBox()))
		return;

	AreasAndPerimeterFormula areasAndPerimeter;
	CentroidFormula centroid;
	computeRegionFeature(*reg, areasAndPerimeter);
	computeRegionFeature(*reg, centroid);
	centroid.setSignedArea(areasAndPerimeter.getSignedArea());

	Region regionData;
	regionData.m_area = areasAndPerimeter.getArea();
	regionData.m_perimeter = areasAndPerimeter.getPerimeter();
	regionData.m_barycentre = centroid.getCentroid() * regionData.m_area;
	regionData.m_size = reg->getBBox().getSize();
	UINT i, subRegCount = reg->getSubregionCount();
	for (i = 0; i < subRegCount; i++) {
		TRegion *subReg = reg->getSubregion(i);
		AreasAndPerimeterFormula subAreasAndPerimeter;
		CentroidFormula subCentroid;
		computeRegionFeature(*subReg, subAreasAndPerimeter);
		computeRegionFeature(*subReg, subCentroid);
		subCentroid.setSignedArea(subAreasAndPerimeter.getSignedArea());

		regionData.m_area -= subAreasAndPerimeter.getArea();
		regionData.m_barycentre -= subCentroid.getCentroid() * subAreasAndPerimeter.getArea();
	}
	regionData.m_barycentre.x /= regionData.m_area;
	regionData.m_barycentre.y /= regionData.m_area;
	regionData.m_styleId = reg->getStyle();
	regionData.m_region = reg;

	rlst[regionIndex] = regionData;
}

//----------------------------------------------------------------------------------------------

void scanSubRegion(TRegion *region, int &index, RegionDataList &rlst, const TRectD &selectingRect)
{
	scanRegion(region, index, rlst, selectingRect);
	index++;
	int j, subRegionCount = region->getSubregionCount();
	for (j = 0; j < subRegionCount; j++) {
		TRegion *subRegion = region->getSubregion(j);
		scanSubRegion(subRegion, index, rlst, selectingRect);
	}
}

//----------------------------------------------------------------------------------------------

bool contains(TRegion *container, TRegion *contained)
{
	if (!(container->getBBox().contains(contained->getBBox())))
		return false;

	for (UINT i = 0; i < contained->getEdgeCount(); i++)
		for (UINT j = 0; j < container->getEdgeCount(); j++)
			if (*contained->getEdge(i) == *container->getEdge(j))
				return false;
	for (UINT i = 0; i < contained->getEdgeCount(); i++) {
		TEdge *e = contained->getEdge(i);
		if (!container->contains(e->m_s->getThickPoint(e->m_w0)))
			return false;
		if (!container->contains(e->m_s->getThickPoint((e->m_w0 + e->m_w1) / 2.0)))
			return false;
		if (!container->contains(e->m_s->getThickPoint(e->m_w1)))
			return false;
	}
	return true;
}

} //namespace

//==============================================================================================

void rect_autofill_learn(const TVectorImageP &imgToLearn, const TRectD &rect)

{
	if (rect.getLx() * rect.getLy() < MIN_SIZE)
		return;

	double pbx, pby;
	double totalArea = 0;
	pbx = pby = 0;

	if (!regionsReference.isEmpty())
		regionsReference.clear();

	int i, index = 0, regionCount = imgToLearn->getRegionCount();
	for (i = 0; i < regionCount; i++) {
		TRegion *region = imgToLearn->getRegion(i);
		if (rect.contains(region->getBBox())) {
			scanRegion(region, index, regionsReference, rect);
			index++;
		}
		int j, subRegionCount = region->getSubregionCount();
		for (j = 0; j < subRegionCount; j++) {
			TRegion *subRegion = region->getSubregion(j);
			if (rect.contains(subRegion->getBBox()))
				scanSubRegion(subRegion, index, regionsReference, rect);
		}
	}

	QMap<int, Region>::Iterator it;
	for (it = regionsReference.begin(); it != regionsReference.end(); it++) {

		pbx += it.value().m_barycentre.x;
		pby += it.value().m_barycentre.y;
		totalArea += it.value().m_area;
	}

	if (totalArea > 0)
		referenceB = TPointD(pbx / totalArea, pby / totalArea);
	else
		referenceB = TPointD(0.0, 0.0);
}

//----------------------------------------------------------------------------

bool rect_autofill_apply(const TVectorImageP &imgToApply, const TRectD &rect, bool selective)
{
	if (rect.getLx() * rect.getLy() < MIN_SIZE)
		return false;

	if (regionsReference.size() <= 0)
		return false;

	double pbx, pby;
	double totalArea = 0;
	pbx = pby = 0.0;

	if (!regionsWork.isEmpty())
		regionsWork.clear();

	int i, index = 0, regionCount = imgToApply->getRegionCount();
	for (i = 0; i < regionCount; i++) {
		TRegion *region = imgToApply->getRegion(i);
		TRectD bbox = region->getBBox();
		if (rect.contains(bbox)) {
			scanRegion(region, index, regionsWork, rect);
			index++;
		}
		int j, subRegionCount = region->getSubregionCount();
		for (j = 0; j < subRegionCount; j++) {
			TRegion *subRegion = region->getSubregion(j);
			if (rect.contains(subRegion->getBBox()))
				scanSubRegion(subRegion, index, regionsWork, rect);
		}
	}

	if (regionsWork.size() <= 0)
		return false;

	QMap<int, Region>::Iterator it;
	for (it = regionsWork.begin(); it != regionsWork.end(); it++) {
		pbx += it.value().m_barycentre.x;
		pby += it.value().m_barycentre.y;
		totalArea += it.value().m_area;
	}

	workB = TPointD(pbx / totalArea, pby / totalArea);

	std::vector<MatchingProbs> probVector;

	RegionDataList::Iterator refIt, workIt;
	for (refIt = regionsReference.begin(); refIt != regionsReference.end(); refIt++)
		for (workIt = regionsWork.begin(); workIt != regionsWork.end(); workIt++)
			assignProbs(probVector, refIt.value(), workIt.value(), refIt.key(), workIt.key());

	bool filledRegions = false;
	for (refIt = regionsReference.begin(); refIt != regionsReference.end(); refIt++) {
		int to = 0, from = 0;
		int valore = 0;
		do
			valore = match(probVector, from, to);
		while ((regionsWork[to].m_match != -1 || regionsReference[from].m_match != -1) && valore > 0);
		if (valore > AMB_TRESH) {
			regionsWork[to].m_match = from;
			regionsReference[from].m_match = to;
			regionsWork[to].m_styleId = regionsReference[from].m_styleId;
			TRegion *reg = regionsWork[to].m_region;
			if (reg && (!selective || selective && reg->getStyle() == 0)) {
				reg->setStyle(regionsWork[to].m_styleId);
				filledRegions = true;
			}
		}
	}
	return filledRegions;
}

//----------------------------------------------------------------------------

void stroke_autofill_learn(const TVectorImageP &imgToLearn, TStroke *stroke)
{
	if (!imgToLearn || !stroke || stroke->getControlPointCount() == 0)
		return;
	TVectorImage appImg;
	TStroke *appStroke = new TStroke(*stroke);
	appImg.addStroke(appStroke);
	appImg.findRegions();

	double pbx, pby;
	double totalArea = 0;
	pbx = pby = 0;

	if (!regionsReference.isEmpty())
		regionsReference.clear();

	int i, j, index = 0;

	for (i = 0; i < (int)imgToLearn->getRegionCount(); i++) {
		TRegion *currentRegion = imgToLearn->getRegion(i);
		for (j = 0; j < (int)appImg.getRegionCount(); j++) {
			TRegion *region = appImg.getRegion(j);
			if (contains(region, currentRegion)) {
				scanRegion(currentRegion, index, regionsReference, region->getBBox());
				index++;
				int k, subRegionCount = currentRegion->getSubregionCount();
				for (k = 0; k < subRegionCount; k++) {
					TRegion *subRegion = currentRegion->getSubregion(k);
					if (contains(region, subRegion))
						scanSubRegion(subRegion, index, regionsReference, region->getBBox());
				}
			}
		}
	}

	QMap<int, Region>::Iterator it;
	for (it = regionsReference.begin(); it != regionsReference.end(); it++) {

		pbx += it.value().m_barycentre.x;
		pby += it.value().m_barycentre.y;
		totalArea += it.value().m_area;
	}

	if (totalArea > 0)
		referenceB = TPointD(pbx / totalArea, pby / totalArea);
	else
		referenceB = TPointD(0.0, 0.0);
}

//----------------------------------------------------------------------------

bool stroke_autofill_apply(const TVectorImageP &imgToApply, TStroke *stroke, bool selective)
{
	if (!imgToApply || !stroke || stroke->getControlPointCount() == 0)
		return false;
	TVectorImage appImg;
	TStroke *appStroke = new TStroke(*stroke);
	appImg.addStroke(appStroke);
	appImg.findRegions();

	if (regionsReference.size() <= 0)
		return false;

	double pbx, pby;
	double totalArea = 0;
	pbx = pby = 0.0;

	if (!regionsWork.isEmpty())
		regionsWork.clear();

	int i, j, index = 0;

	for (i = 0; i < (int)imgToApply->getRegionCount(); i++) {
		TRegion *currentRegion = imgToApply->getRegion(i);
		for (j = 0; j < (int)appImg.getRegionCount(); j++) {
			TRegion *region = appImg.getRegion(j);
			if (contains(region, currentRegion)) {
				scanRegion(currentRegion, index, regionsWork, region->getBBox());
				index++;
				int k, subRegionCount = currentRegion->getSubregionCount();
				for (k = 0; k < subRegionCount; k++) {
					TRegion *subRegion = currentRegion->getSubregion(k);
					if (contains(region, subRegion))
						scanSubRegion(subRegion, index, regionsWork, region->getBBox());
				}
			}
		}
	}

	if (regionsWork.size() <= 0)
		return false;

	QMap<int, Region>::Iterator it;
	for (it = regionsWork.begin(); it != regionsWork.end(); it++) {
		pbx += it.value().m_barycentre.x;
		pby += it.value().m_barycentre.y;
		totalArea += it.value().m_area;
	}

	workB = TPointD(pbx / totalArea, pby / totalArea);

	std::vector<MatchingProbs> probVector;

	RegionDataList::Iterator refIt, workIt;
	for (refIt = regionsReference.begin(); refIt != regionsReference.end(); refIt++)
		for (workIt = regionsWork.begin(); workIt != regionsWork.end(); workIt++)
			assignProbs(probVector, refIt.value(), workIt.value(), refIt.key(), workIt.key());

	bool filledRegions = false;
	for (refIt = regionsReference.begin(); refIt != regionsReference.end(); refIt++) {
		int to = 0, from = 0;
		int valore = 0;
		do
			valore = match(probVector, from, to);
		while ((regionsWork[to].m_match != -1 || regionsReference[from].m_match != -1) && valore > 0);
		if (valore > AMB_TRESH) {
			regionsWork[to].m_match = from;
			regionsReference[from].m_match = to;
			regionsWork[to].m_styleId = regionsReference[from].m_styleId;
			TRegion *reg = regionsWork[to].m_region;
			if (reg && (!selective || selective && reg->getStyle() == 0)) {
				reg->setStyle(regionsWork[to].m_styleId);
				filledRegions = true;
			}
		}
	}
	return filledRegions;
}