/* 
 * PROJECT: NyARToolkitCS(Extension)
 * --------------------------------------------------------------------------------
 * The NyARToolkitCS is C# edition ARToolKit class library.
 * Copyright (C)2008-2009 Ryo Iizuka
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 * 
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 * 
 * For further information please contact.
 *	http://nyatla.jp/nyatoolkit/
 *	<airmail(at)ebony.plala.or.jp> or <nyatla(at)nyatla.jp>
 * 
 */
using System;
using System.Collections.Generic;
using System.Text;
using System.Diagnostics;

namespace jp.nyatla.nyartoolkit.cs.core
{
    /**
     * 遠近法を使ったパースペクティブ補正をかけて、ラスタ上の四角形から
     * 任意解像度の矩形パターンを作成します。
     *
     */
    public class NyARColorPatt_Perspective : INyARColorPatt
    {
        protected int[] _patdata;
        protected NyARIntPoint2d _pickup_lt = new NyARIntPoint2d();
        protected int _resolution;
        protected NyARBufferReader _buf_reader;
        protected NyARIntSize _size;
        protected NyARPerspectiveParamGenerator_O1 _perspective_gen;
        private NyARRgbPixelReader_INT1D_X8R8G8B8_32 _pixelreader;
        private const int LOCAL_LT = 1;

        private void initializeInstance(int i_width, int i_height, int i_point_per_pix)
        {
            Debug.Assert(i_width > 2 && i_height > 2);
            this._resolution = i_point_per_pix;
            this._size = new NyARIntSize(i_width, i_height);
            this._patdata = new int[i_height * i_width];
            this._buf_reader = new NyARBufferReader(this._patdata, NyARBufferReader.BUFFERFORMAT_INT1D_X8R8G8B8_32);
            this._pixelreader = new NyARRgbPixelReader_INT1D_X8R8G8B8_32(this._patdata, this._size);
            return;
        }

        /**
         * 例えば、64
         * @param i_width
         * 取得画像の解像度幅
         * @param i_height
         * 取得画像の解像度高さ
	     * @param i_point_per_pix
	     * 1ピクセルあたりの縦横サンプリング数。2なら2x2=4ポイントをサンプリングする。
         */
        public NyARColorPatt_Perspective(int i_width, int i_height, int i_point_per_pix)
        {
            initializeInstance(i_width, i_height, i_point_per_pix);
            setEdgeSize(0, 0, i_point_per_pix);
            return;
        }
        /**
         * 例えば、64
         * @param i_width
         * 取得画像の解像度幅
         * @param i_height
         * 取得画像の解像度高さ
         * @param i_edge_percentage
         * エッジ幅の割合(ARToolKit標準と同じなら、25)
         */
        public NyARColorPatt_Perspective(int i_width, int i_height, int i_resolution, int i_edge_percentage)
        {
            //入力制限
            initializeInstance(i_width, i_height, i_resolution);
            setEdgeSizeByPercent(i_edge_percentage, i_edge_percentage, i_resolution);
            return;
        }
        /**
         * 矩形領域のエッジサイズを指定します。
         * エッジの計算方法は以下の通りです。
         * 1.マーカ全体を(i_x_edge*2+width)x(i_y_edge*2+height)の解像度でパラメタを計算します。
         * 2.ピクセルの取得開始位置を(i_x_edge/2,i_y_edge/2)へ移動します。
         * 3.開始位置から、width x height個のピクセルを取得します。
         * 
         * ARToolKit標準マーカの場合は、width/2,height/2を指定してください。
         * @param i_x_edge
         * @param i_y_edge
         */
        public void setEdgeSize(int i_x_edge, int i_y_edge, int i_resolution)
        {
            Debug.Assert(i_x_edge >= 0);
            Debug.Assert(i_y_edge >= 0);
            //Perspectiveパラメタ計算器を作成
            this._perspective_gen = new NyARPerspectiveParamGenerator_O1(
                LOCAL_LT, LOCAL_LT,
                (i_x_edge * 2 + this._size.w) * i_resolution,
                (i_y_edge * 2 + this._size.h) * i_resolution);
            //ピックアップ開始位置を計算
            this._pickup_lt.x = i_x_edge * i_resolution + LOCAL_LT;
            this._pickup_lt.y = i_y_edge * i_resolution + LOCAL_LT;
            return;
        }
        public void setEdgeSizeByPercent(int i_x_percent, int i_y_percent, int i_resolution)
        {
            Debug.Assert(i_x_percent >= 0);
            Debug.Assert(i_y_percent >= 0);
            setEdgeSize(this._size.w * i_x_percent / 50, this._size.h * i_y_percent / 50, i_resolution);
            return;
        }


        public int getWidth()
        {
            return this._size.w;
        }
        public int getHeight()
        {
            return this._size.h;
        }
        public NyARIntSize getSize()
        {
            return this._size;
        }
        public INyARBufferReader getBufferReader()
        {
            return this._buf_reader;
        }
        public INyARRgbPixelReader getRgbPixelReader()
        {
            return this._pixelreader;
        }
        private int[] __pickFromRaster_rgb_tmp = new int[3];
        protected double[] __pickFromRaster_cpara = new double[8];

        /**
         * @see INyARColorPatt#pickFromRaster
         */
        public virtual bool pickFromRaster(INyARRgbRaster image, NyARIntPoint2d[] i_vertexs)
        {
            //遠近法のパラメータを計算
            double[] cpara = this.__pickFromRaster_cpara;
            if (!this._perspective_gen.getParam(i_vertexs, cpara))
            {
                return false;
            }

            int resolution = this._resolution;
            int img_x = image.getWidth();
            int img_y = image.getHeight();
            int res_pix = resolution * resolution;

            int[] rgb_tmp = this.__pickFromRaster_rgb_tmp;

            //ピクセルリーダーを取得
            INyARRgbPixelReader reader = image.getRgbPixelReader();
            int p = 0;
            for (int iy = 0; iy < this._size.h * resolution; iy += resolution)
            {
                //解像度分の点を取る。
                for (int ix = 0; ix < this._size.w * resolution; ix += resolution)
                {
                    int r, g, b;
                    r = g = b = 0;
                    for (int i2y = iy; i2y < iy + resolution; i2y++)
                    {
                        int cy = this._pickup_lt.y + i2y;
                        for (int i2x = ix; i2x < ix + resolution; i2x++)
                        {
                            //1ピクセルを作成
                            int cx = this._pickup_lt.x + i2x;
                            double d = cpara[6] * cx + cpara[7] * cy + 1.0;
                            int x = (int)((cpara[0] * cx + cpara[1] * cy + cpara[2]) / d);
                            int y = (int)((cpara[3] * cx + cpara[4] * cy + cpara[5]) / d);
                            if (x < 0) { x = 0; }
                            if (x >= img_x) { x = img_x - 1; }
                            if (y < 0) { y = 0; }
                            if (y >= img_y) { y = img_y - 1; }

                            reader.getPixel(x, y, rgb_tmp);
                            r += rgb_tmp[0];
                            g += rgb_tmp[1];
                            b += rgb_tmp[2];
                        }
                    }
                    r /= res_pix;
                    g /= res_pix;
                    b /= res_pix;
                    this._patdata[p] = ((r & 0xff) << 16) | ((g & 0xff) << 8) | ((b & 0xff));
                    p++;
                }
            }
            //ピクセル問い合わせ
            //ピクセルセット
            return true;
        }
    }
}
