#ifndef TCG_IMAGE_ITERATOR_HPP
#define TCG_IMAGE_ITERATOR_HPP

// tcg includes
#include "../image_iterator.h"
#include "../pixel_ops.h"

namespace tcg
{

//***************************************************************************
//    image_edge_iterator  implementation
//***************************************************************************

template <typename It, _iei_adherence_policy _adherence>
template <typename Img>
image_edge_iterator<It, _adherence>::image_edge_iterator(
	const Img &img, int x, int y, int dirX, int dirY)
	: m_lx_1(image_traits<Img>::width(img) - 1), m_ly_1(image_traits<Img>::height(img) - 1), m_wrap(image_traits<Img>::wrap(img)), m_pos(x, y), m_dir(dirX, dirY), m_outsideColor(image_traits<Img>::outsideColor(img)), m_elbowColor(m_outsideColor), m_pix(image_traits<Img>::pixel(img, x, y)), m_turn(UNKNOWN)
{
	pixels(m_leftPix, m_rightPix);
	colors(m_leftColor, m_rightColor);
}

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

template <typename It, _iei_adherence_policy _adherence>
inline void image_edge_iterator<It, _adherence>::pixels(
	iter pixLeft, iter pixRight)
{
	if (m_dir.y)
		if (m_dir.y > 0)
			pixLeft = m_pix - 1, pixRight = m_pix;
		else
			pixLeft = m_pix - m_wrap, pixRight = pixLeft - 1;
	else if (m_dir.x > 0)
		pixLeft = m_pix, pixRight = m_pix - m_wrap;
	else
		pixRight = m_pix - 1, pixLeft = pixRight - m_wrap;
}

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

template <typename It, _iei_adherence_policy _adherence>
inline void image_edge_iterator<It, _adherence>::colors(
	value_type &leftColor, value_type &rightColor)
{
	if (m_dir.y)
		if (m_dir.y > 0) {
			if (m_pos.y > m_ly_1)
				leftColor = rightColor = m_outsideColor;
			else {
				leftColor = (m_pos.x > 0) ? *m_leftPix : m_outsideColor;
				rightColor = (m_pos.x <= m_lx_1) ? *m_rightPix : m_outsideColor;
			}
		} else {
			if (m_pos.y < 1)
				leftColor = rightColor = m_outsideColor;
			else {
				leftColor = (m_pos.x <= m_lx_1) ? *m_leftPix : m_outsideColor;
				rightColor = (m_pos.x > 0) ? *m_rightPix : m_outsideColor;
			}
		}
	else if (m_dir.x > 0) {
		if (m_pos.x > m_lx_1)
			leftColor = rightColor = m_outsideColor;
		else {
			leftColor = (m_pos.y <= m_ly_1) ? *m_leftPix : m_outsideColor;
			rightColor = (m_pos.y > 0) ? *m_rightPix : m_outsideColor;
		}
	} else {
		if (m_pos.x < 1)
			leftColor = rightColor = m_outsideColor;
		else {
			leftColor = (m_pos.y > 0) ? *m_leftPix : m_outsideColor;
			rightColor = (m_pos.y <= m_ly_1) ? *m_rightPix : m_outsideColor;
		}
	}
}

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

template <typename It, _iei_adherence_policy _adherence>
inline void image_edge_iterator<It, _adherence>::turn(
	const value_type &newLeftColor, const value_type &newRightColor,
	policy<RIGHT_ADHERENCE>)
{
	if (newLeftColor == m_rightColor) {
		if (newRightColor == m_leftColor)
			turnAmbiguous(newLeftColor, newRightColor);
		else
			turnLeft();
	} else {
		if (newRightColor != m_rightColor)
			turnRight();
		else
			m_turn = STRAIGHT;
	}

	m_elbowColor = newLeftColor;

	pixels(m_leftPix, m_rightPix);
}

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

template <typename It, _iei_adherence_policy _adherence>
inline void image_edge_iterator<It, _adherence>::turn(
	const value_type &newLeftColor, const value_type &newRightColor,
	policy<LEFT_ADHERENCE>)
{
	if (newRightColor == m_leftColor) {
		if (newLeftColor == m_rightColor)
			turnAmbiguous(newLeftColor, newRightColor);
		else
			turnRight();
	} else {
		if (newLeftColor != m_leftColor)
			turnLeft();
		else
			m_turn = STRAIGHT;
	}

	m_elbowColor = newRightColor;

	pixels(m_leftPix, m_rightPix);
}

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

template <typename It, _iei_adherence_policy _adherence>
inline void image_edge_iterator<It, _adherence>::turnAmbiguous(
	const value_type &newLeftColor, const value_type &newRightColor)
{
	UCHAR count1 = 0, count2 = 0;

	value_type val;

	// Check the 4x4 neighbourhood and connect the minority color
	if (m_pos.x > 2) {
		val = *(m_pix - 2);
		if (val == m_leftColor)
			++count1;
		else if (val == m_rightColor)
			++count2;

		val = *(m_pix - 2 - m_wrap);
		if (val == m_leftColor)
			++count1;
		else if (val == m_rightColor)
			++count2;
	}

	if (m_pos.x < m_lx_1) {
		val = *(m_pix + 1);
		if (val == m_leftColor)
			++count1;
		else if (val == m_rightColor)
			++count2;

		val = *(m_pix + 1 - m_wrap);
		if (val == m_leftColor)
			++count1;
		else if (val == m_rightColor)
			++count2;
	}

	if (m_pos.y > 2) {
		int wrap2 = m_wrap << 1;

		val = *(m_pix - wrap2);
		if (val == m_leftColor)
			++count1;
		else if (val == m_rightColor)
			++count2;

		val = *(m_pix - wrap2 - 1);
		if (val == m_leftColor)
			++count1;
		else if (val == m_rightColor)
			++count2;
	}

	if (m_pos.y < m_ly_1) {
		val = *(m_pix + m_wrap);
		if (val == m_leftColor)
			++count1;
		else if (val == m_rightColor)
			++count2;

		val = *(m_pix + m_wrap - 1);
		if (val == m_leftColor)
			++count1;
		else if (val == m_rightColor)
			++count2;
	}

	// Minority connection - join the one with less count
	if (count1 <= count2)
		turnRight(); // Join m_leftColor == newRightColor
	else if (count1 > count2)
		turnLeft(); // Join m_rightColor == newLeftColor

	m_turn |= AMBIGUOUS;
}

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

template <typename It, _iei_adherence_policy _adherence>
void image_edge_iterator<It, _adherence>::advance(policy<RIGHT_ADHERENCE>)
{
	value_type newLeftColor = m_leftColor, newRightColor = m_rightColor;

	int pixAdd = m_dir.y * m_wrap + m_dir.x;

	m_pos.x += m_dir.x, m_pos.y += m_dir.y;
	m_pix += pixAdd, m_leftPix += pixAdd, m_rightPix += pixAdd;
	m_leftColor = newLeftColor;

	colors(newLeftColor, newRightColor);

	turn(newLeftColor, newRightColor);
	colors(m_leftColor, m_rightColor);
}

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

template <typename It, _iei_adherence_policy _adherence>
void image_edge_iterator<It, _adherence>::advance(policy<LEFT_ADHERENCE>)
{
	value_type newLeftColor = m_leftColor, newRightColor = m_rightColor;

	int pixAdd = m_dir.y * m_wrap + m_dir.x;

	m_pos.x += m_dir.x, m_pos.y += m_dir.y;
	m_pix += pixAdd, m_leftPix += pixAdd, m_rightPix += pixAdd;
	m_rightColor = newRightColor;

	colors(newLeftColor, newRightColor);

	turn(newLeftColor, newRightColor);
	colors(m_leftColor, m_rightColor);
}

} // namespace tcg

#endif // TCG_IMAGE_ITERATOR_HPP