/*------------------------------------
Iwa_PerspectiveDistortFx
奥行き方向に台形歪みを行うエフェクト
ディティールを保持するため、引き伸ばす量に応じて素材の解像度を上げる
------------------------------------*/

#include "iwa_perspectivedistortfx.h"

#include "tparamuiconcept.h"
//#include "ino_common.h"

namespace
{

float4 getSource_CPU(float4 *source_host,
					 TDimensionI &dim,
					 int pos_x, int pos_y)
{
	if (pos_x < 0 || pos_x >= dim.lx ||
		pos_y < 0 || pos_y >= dim.ly)
		return float4{0.0f, 0.0f, 0.0f, 0.0f};

	return source_host[pos_y * dim.lx + pos_x];
}

float4 interp_CPU(float4 val1,
				  float4 val2,
				  float ratio)
{
	return float4{(1.0f - ratio) * val1.x + ratio * val2.x,
				  (1.0f - ratio) * val1.y + ratio * val2.y,
				  (1.0f - ratio) * val1.z + ratio * val2.z,
				  (1.0f - ratio) * val1.w + ratio * val2.w};
}
}

/*------------------------------------------------------------
 出力結果をChannel値に変換して格納
------------------------------------------------------------*/

template <typename RASTER, typename PIXEL>
void Iwa_PerspectiveDistortFx::setOutputRaster(float4 *srcMem,
											   const RASTER dstRas,
											   TDimensionI dim,
											   int drawLevel)
{

	typename PIXEL::Channel halfChan = (typename PIXEL::Channel)(PIXEL::maxChannelValue / 2);

	dstRas->fill(PIXEL::Transparent);

	float4 *chan_p = srcMem;
	for (int j = 0; j < drawLevel; j++) {
		if (j >= dstRas->getLy())
			break;

		PIXEL *pix = dstRas->pixels(j);
		for (int i = 0; i < dstRas->getLx(); i++, chan_p++, pix++) {
			float val;
			val = (*chan_p).x * (float)PIXEL::maxChannelValue + 0.5f;
			pix->r = (typename PIXEL::Channel)((val > (float)PIXEL::maxChannelValue) ? (float)PIXEL::maxChannelValue : val);
			val = (*chan_p).y * (float)PIXEL::maxChannelValue + 0.5f;
			pix->g = (typename PIXEL::Channel)((val > (float)PIXEL::maxChannelValue) ? (float)PIXEL::maxChannelValue : val);
			val = (*chan_p).z * (float)PIXEL::maxChannelValue + 0.5f;
			pix->b = (typename PIXEL::Channel)((val > (float)PIXEL::maxChannelValue) ? (float)PIXEL::maxChannelValue : val);
			val = (*chan_p).w * (float)PIXEL::maxChannelValue + 0.5f;
			pix->m = (typename PIXEL::Channel)((val > (float)PIXEL::maxChannelValue) ? (float)PIXEL::maxChannelValue : val);
		}
	}
}

/*------------------------------------------------------------
 ソース画像を０〜１に正規化してホストメモリに読み込む
------------------------------------------------------------*/

template <typename RASTER, typename PIXEL>
void Iwa_PerspectiveDistortFx::setSourceRaster(const RASTER srcRas,
											   float4 *dstMem,
											   TDimensionI dim)
{
	float4 *chann_p = dstMem;
	for (int j = 0; j < dim.ly; j++) {
		PIXEL *pix = srcRas->pixels(j);
		for (int i = 0; i < dim.lx; i++, pix++, chann_p++) {
			(*chann_p).x = (float)pix->r / (float)PIXEL::maxChannelValue;
			(*chann_p).y = (float)pix->g / (float)PIXEL::maxChannelValue;
			(*chann_p).z = (float)pix->b / (float)PIXEL::maxChannelValue;
			(*chann_p).w = (float)pix->m / (float)PIXEL::maxChannelValue;
		}
	}
}

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

Iwa_PerspectiveDistortFx::Iwa_PerspectiveDistortFx()
	: m_vanishingPoint(TPointD(0, 0)), m_anchorPoint(TPointD(0, -100.0)), m_precision(300.0 / 162.5)
{
	/*- 共通パラメータのバインド -*/
	addInputPort("Source", m_source);

	bindParam(this, "vanishingPoint", m_vanishingPoint);
	bindParam(this, "anchorPoint", m_anchorPoint);
	bindParam(this, "precision", m_precision);

	m_vanishingPoint->getX()->setMeasureName("fxLength");
	m_vanishingPoint->getY()->setMeasureName("fxLength");
	m_anchorPoint->getX()->setMeasureName("fxLength");
	m_anchorPoint->getY()->setMeasureName("fxLength");

	m_precision->setValueRange(1.0, 2.0);
}

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

bool Iwa_PerspectiveDistortFx::doGetBBox(double frame,
										 TRectD &bBox,
										 const TRenderSettings &info)
{
	if (m_source.isConnected()) {
		bool ret = m_source->doGetBBox(frame, bBox, info);
		if (ret)
			bBox = TConsts::infiniteRectD;
		return ret;
	}
	return false;
}

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

bool Iwa_PerspectiveDistortFx::canHandle(const TRenderSettings &info,
										 double frame)
{
	return false;
}

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

void Iwa_PerspectiveDistortFx::doCompute(TTile &tile,
										 double frame,
										 const TRenderSettings &rend_sets)
{
	/*- ソース画像が刺さっていなければreturn -*/
	if (!m_source.isConnected()) {
		tile.getRaster()->clear();
		return;
	}

	/*- パラメータの取得 -*/
	TPointD vp = m_vanishingPoint->getValue(frame);
	TPointD ap = m_anchorPoint->getValue(frame);
	double precision = m_precision->getValue(frame);

	/*- 基準点が消失点よりも上にあったらreturn -*/
	if (vp.y <= ap.y) {
		std::cout << "the anchor must be lower than the vanishing point" << std::endl;
		tile.getRaster()->clear();
		return;
	}

	TAffine aff = rend_sets.m_affine;
	/*- カメラ左下を中心としたピクセル座標に変換する -*/
	TPointD vanishingPoint = aff * vp - (tile.m_pos + tile.getRaster()->getCenterD()) + TPointD(rend_sets.m_cameraBox.getLx() / 2.0, rend_sets.m_cameraBox.getLy() / 2.0);
	TPointD anchorPoint = aff * ap - (tile.m_pos + tile.getRaster()->getCenterD()) + TPointD(rend_sets.m_cameraBox.getLx() / 2.0, rend_sets.m_cameraBox.getLy() / 2.0);

	double offs = vanishingPoint.x - rend_sets.m_cameraBox.getLx() / 2.0;

	/*- 取り込む解像度の倍率 -*/

	TRectD rectOut(tile.m_pos, TDimensionD(
								   tile.getRaster()->getLx(), tile.getRaster()->getLy()));
	TDimensionI outDim(rectOut.getLx(), rectOut.getLy());
	/*- ソース画像を正規化して格納 -*/
	/*- 素材を拡大させて持ち込む -*/
	TDimensionI sourceDim(rectOut.getLx() * (int)tceil(precision), anchorPoint.y);
	float4 *source_host;
	TRasterGR8P source_host_ras(sourceDim.lx * sizeof(float4), sourceDim.ly);
	source_host_ras->lock();
	source_host = (float4 *)source_host_ras->getRawData();
	{

		TRenderSettings new_sets(rend_sets);

		new_sets.m_affine *= TTranslation(vp.x, vp.y);
		new_sets.m_affine *= TScale(precision, 1.0);
		new_sets.m_affine *= TTranslation(-vp.x, -vp.y);

		double sourcePosX = offs + precision * (tile.m_pos.x - offs);

		TTile sourceTile;
		m_source->allocateAndCompute(
			sourceTile, TPointD(sourcePosX, tile.m_pos.y),
			sourceDim, tile.getRaster(), frame, new_sets);

		/*- タイルの画像を０〜１に正規化してホストメモリに読み込む -*/
		TRaster32P ras32 = (TRaster32P)sourceTile.getRaster();
		TRaster64P ras64 = (TRaster64P)sourceTile.getRaster();
		if (ras32)
			setSourceRaster<TRaster32P, TPixel32>(ras32, source_host, sourceDim);
		else if (ras64)
			setSourceRaster<TRaster64P, TPixel64>(ras64, source_host, sourceDim);
	}

	TDimensionI resultDim(rectOut.getLx(), anchorPoint.y);
	TRasterGR8P result_host_ras(resultDim.lx * sizeof(float4), resultDim.ly);
	/*- 結果を収めるメモリ -*/
	float4 *result_host;
	result_host_ras->lock();
	result_host = (float4 *)result_host_ras->getRawData();

	doCompute_CPU(tile, frame, rend_sets,
				  vanishingPoint,
				  anchorPoint,
				  source_host,
				  result_host,
				  sourceDim,
				  resultDim,
				  precision,
				  offs);

	source_host_ras->unlock();

	/*- 出力結果をChannel値に変換して格納 -*/
	TRaster32P outRas32 = (TRaster32P)tile.getRaster();
	TRaster64P outRas64 = (TRaster64P)tile.getRaster();
	if (outRas32)
		setOutputRaster<TRaster32P, TPixel32>(result_host, outRas32, outDim, resultDim.ly);
	else if (outRas64)
		setOutputRaster<TRaster64P, TPixel64>(result_host, outRas64, outDim, resultDim.ly);

	result_host_ras->unlock();
}

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

void Iwa_PerspectiveDistortFx::doCompute_CPU(TTile &tile,
											 const double frame,
											 const TRenderSettings &settings,
											 TPointD &vp,
											 TPointD &ap,
											 float4 *source_host,
											 float4 *result_host,
											 TDimensionI &sourceDim,
											 TDimensionI &resultDim,
											 const double precision,
											 const double offs)
{
	/*- 結果ポインタ -*/
	float4 *result_p = result_host;
	/*- 結果画像内でループ -*/
	for (int j = 0; j < resultDim.ly; j++) {
		/*- サンプルスタート地点 -*/
		double sampleX = precision * (vp.x * (ap.y - (double)j) / (vp.y - (double)j));
		/*- 1ピクセル横に移動した場合のサンプリング位置の移動量 -*/
		double dx = precision * (vp.y - ap.y) / (vp.y - (double)j);
		for (int i = 0; i < resultDim.lx; i++, result_p++, sampleX += dx) {
			int index = (int)tfloor(sampleX);
			double ratio = sampleX - (double)index;
			(*result_p) = interp_CPU(getSource_CPU(source_host, sourceDim, index, j),
									 getSource_CPU(source_host, sourceDim, index + 1, j),
									 ratio);
		}
	}
}

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

void Iwa_PerspectiveDistortFx::getParamUIs(TParamUIConcept *&concepts, int &length)
{
	concepts = new TParamUIConcept[length = 2];

	concepts[0].m_type = TParamUIConcept::POINT;
	concepts[0].m_label = "Vanishing Point";
	concepts[0].m_params.push_back(m_vanishingPoint);

	concepts[1].m_type = TParamUIConcept::POINT;
	concepts[1].m_label = "Anchor Point";
	concepts[1].m_params.push_back(m_anchorPoint);
}

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

FX_PLUGIN_IDENTIFIER(Iwa_PerspectiveDistortFx, "iwa_PerspectiveDistortFx")