/* 
 * PROJECT: NyARToolkit
 * --------------------------------------------------------------------------------
 * This work is based on the original ARToolKit developed by
 *   Hirokazu Kato
 *   Mark Billinghurst
 *   HITLab, University of Washington, Seattle
 * http://www.hitl.washington.edu/artoolkit/
 *
 * The NyARToolkit is Java version ARToolkit class library.
 * Copyright (C)2008 R.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 2
 * 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 framework; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 * 
 * For further information please contact.
 *	http://nyatla.jp/nyatoolkit/
 *	<airmail(at)ebony.plala.or.jp>
 * 
 */
package jp.nyatla.nyartoolkit.core;




import jp.nyatla.nyartoolkit.NyARException;




/**
 * イメージからマーカー情報を検出するクラス。
 * このクラスは、arDetectMarker2.cとの置き換えになります。
 * ラベリング済みのラスタデータからマーカー位置を検出して、結果を保持します。
 *
 */
public class NyARDetectMarker {
    private static final int AR_AREA_MAX=100000;//#define   AR_AREA_MAX      100000
    private static final int AR_AREA_MIN=70;//#define   AR_AREA_MIN          70

//    private final NyARMarker[] marker_holder;	    //マーカーデータの保持配列
//    private final NyARMarker[] marker_info2_array;//マーカーデータのインデックス配列
//    private int marker_num;
    private int width,height;
    /**
     * 最大i_squre_max個のマーカーを検出するクラスを作成する。
     * @param i_width
     * @param i_height
     */
    public NyARDetectMarker(int i_width,int i_height)
    {
	this.width =i_width;
	this.height=i_height;
	
//	this.marker_holder=new NyARMarker[i_squre_max];
//	this.marker_info2_array=new NyARMarker[i_squre_max];
//	//先にマーカーホルダにオブジェクトを作っておく
//	for(int i=0;i<i_squre_max;i++){
//	    this.marker_holder[i]=new NyARMarker();
//	}
    }
    private static final int AR_CHAIN_MAX=10000;
    private final int[] wk_arGetContour_xdir={0,  1, 1, 1, 0,-1,-1,-1};
    private final int[] wk_arGetContour_ydir={-1,-1, 0, 1, 1, 1, 0,-1};
    private final int[] wk_arGetContour_xcoord=new int[AR_CHAIN_MAX];
    private final int[] wk_arGetContour_ycoord=new int[AR_CHAIN_MAX];
    /**
     * int arGetContour( ARInt16 *limage, int *label_ref,int label, int clip[4], ARMarkerInfo2 *marker_info2 )
     * 関数の代替品
     * detectMarker関数から使う関数です。o_markerにlabelとclipで示される1個のマーカーを格納します。
     * marker_holder[i_holder_num]にオブジェクトが無ければまず新規に作成し、もし
     * 既に存在すればそこにマーカー情報を上書きして記録します。
     * Optimize:STEP[591->543]
     * @param o_marker
     * @param limage
     * @param label_ref
     * @param label
     * @param clip
     * @throws NyARException
     */
    private final void arGetContour(NyARMarker o_marker,int[][] limage, int[] label_ref,int i_labelnum, NyARLabel i_label) throws NyARException
    {
	final int[] xcoord=wk_arGetContour_xcoord;
	final int[] ycoord=wk_arGetContour_ycoord;
	final int[] xdir=wk_arGetContour_xdir; //static int      xdir[8] = { 0, 1, 1, 1, 0,-1,-1,-1};
	final int[] ydir=wk_arGetContour_ydir;//static int      ydir[8] = {-1,-1, 0, 1, 1, 1, 0,-1};
	//ShortPointer p1;//ARInt16         *p1;
	int coord_num;
	int             sx=0, sy=0, dir;
	int             dmax, d, v1=0;
	int             i, j,w;

	int[] limage_j;
	j = i_label.clip2;
	limage_j=limage[j];
	final int clip1=i_label.clip1;
	//p1=ShortPointer.wrap(limage,j*xsize+clip.get());//p1 = &(limage[j*xsize+clip[0]]);
	for( i = i_label.clip0; i <= clip1; i++){//for( i = clip[0]; i <= clip[1]; i++, p1++ ) {
	    w=limage_j[i];
	    if(w > 0 && label_ref[w-1] == i_labelnum ) {//if( *p1 > 0 && label_ref[(*p1)-1] == label ) {
		sx = i;
		sy = j;
		break;
	    }
	}
	if(i>clip1){//if( i > clip[1] ) {
	    System.out.println("??? 1");//printf();
	    throw new NyARException();//return(-1);
	}

//	//マーカーホルダが既に確保済みかを調べる
//	if(marker_holder[i_holder_num]==null){
//	    //確保していなければ確保
//	    marker_holder[i_holder_num]=new NyARMarker();
//	}


	coord_num=1;//marker_info2->coord_num = 1;
	xcoord[0]=sx;//marker_info2->x_coord[0] = sx;
	ycoord[0]=sy;//marker_info2->y_coord[0] = sy;
	dir = 5;
	
	int r,c;

	for(;;){
	    r=ycoord[coord_num-1];
	    c=xcoord[coord_num-1];
	    //p1 = &(limage[marker_info2->y_coord[marker_info2->coord_num-1] * xsize+ marker_info2->x_coord[marker_info2->coord_num-1]]);
	    dir = (dir+5)%8;
	    for(i=0;i<8;i++) {
		if(limage[r+ydir[dir]][c+xdir[dir]]>0){//if( p1[ydir[dir]*xsize+xdir[dir]] > 0 ){
		    break;
		}
		dir = (dir+1)%8;	
	    }
	    if( i == 8 ){
		System.out.println("??? 2");//printf("??? 2\n");
		throw new NyARException();//return(-1);
	    }
	    xcoord[coord_num]= xcoord[coord_num-1] + xdir[dir];//marker_info2->x_coord[marker_info2->coord_num]= marker_info2->x_coord[marker_info2->coord_num-1] + xdir[dir];
	    ycoord[coord_num]= ycoord[coord_num-1] + ydir[dir];//marker_info2->y_coord[marker_info2->coord_num]= marker_info2->y_coord[marker_info2->coord_num-1] + ydir[dir];
	    if(xcoord[coord_num] == sx && ycoord[coord_num] == sy ){
		break;
	    }
	    coord_num++;
	    if(coord_num == xcoord.length-1){//if( marker_info2.coord_num == Config.AR_CHAIN_MAX-1 ){
		System.out.println("??? 3");//printf("??? 3\n");
		throw new NyARException();//return(-1);
	    }
	}

	dmax = 0;
	for(i=1;i<coord_num;i++) {//	for(i=1;i<marker_info2->coord_num;i++) {
	    d = (xcoord[i]-sx)*(xcoord[i]-sx)+ (ycoord[i]-sy)*(ycoord[i]-sy);//	  d = (marker_info2->x_coord[i]-sx)*(marker_info2->x_coord[i]-sx)+ (marker_info2->y_coord[i]-sy)*(marker_info2->y_coord[i]-sy);
	    if( d > dmax ) {
		dmax = d;
		v1 = i;
	    }
	}
	//NyARMarkerへcoord情報をセット
	//coordの並び替えと保存はNyARMarkerへ移動
	o_marker.setCoordXY(v1,coord_num,xcoord,ycoord);

//	int[]      wx=new int[v1];//new int[Config.AR_CHAIN_MAX];
//	int[]      wy=new int[v1]; //new int[Config.AR_CHAIN_MAX];   
//	for(i=0;i<v1;i++) {
//	    wx[i] = marker_ref.x_coord[i];//wx[i] = marker_info2->x_coord[i];
//	    wy[i] = marker_ref.y_coord[i];//wy[i] = marker_info2->y_coord[i];
//	}
//	for(i=0;i<marker_ref.coord_num-v1;i++) {//for(i=v1;i<marker_info2->coord_num;i++) {
//	    marker_ref.x_coord[i] = marker_ref.x_coord[i+v1];//marker_info2->x_coord[i-v1] = marker_info2->x_coord[i];
//	    marker_ref.y_coord[i] = marker_ref.y_coord[i+v1];//marker_info2->y_coord[i-v1] = marker_info2->y_coord[i];
//	}
//	for(i=0;i<v1;i++) {
//	    marker_ref.x_coord[i-v1+marker_ref.coord_num] = wx[i];//marker_info2->x_coord[i-v1+marker_info2->coord_num] = wx[i];
//	    marker_ref.y_coord[i-v1+marker_ref.coord_num] = wy[i];//marker_info2->y_coord[i-v1+marker_info2->coord_num] = wy[i];
//	}
//	marker_ref.x_coord[marker_ref.coord_num] = marker_ref.x_coord[0];//marker_info2->x_coord[marker_info2->coord_num] = marker_info2->x_coord[0];
//	marker_ref.y_coord[marker_ref.coord_num] = marker_ref.y_coord[0];//marker_info2->y_coord[marker_info2->coord_num] = marker_info2->y_coord[0];
//	marker_ref.coord_num++;//marker_info2->coord_num++;
	return;
    }

    /**
     * ARMarkerInfo2 *arDetectMarker2( ARInt16 *limage, int label_num, int *label_ref,int *warea, double *wpos, int *wclip,int area_max, int area_min, double factor, int *marker_num )
     * 関数の代替品
     * ラベリング情報からマーカー一覧を作成してo_marker_listを更新します。
     * 関数はo_marker_listに重なりを除外したマーカーリストを作成します。
     * 
     * @param i_labeling
     * ラベリング済みの情報を持つラベリングオブジェクト
     * @param i_factor
     * 何かの閾値？
     * @param o_marker_list
     * 抽出したマーカーを格納するリスト
     * @throws NyARException
     */
    public final void detectMarker(NyARLabeling i_labeling,double i_factor,NyARMarkerList o_marker_list) throws NyARException
    {
	int i;
	int               xsize, ysize;
	NyARLabel[] labels=i_labeling.getLabel();
//	int[] warea  	=i_labeling.getArea();
	int label_num	=i_labeling.getLabelNum();
//	int[][] wclip	=i_labeling.getClip();
//	double[] wpos	=i_labeling.getPos();
	int[][] limage=i_labeling.getLabelImg();
	int[] label_ref	=i_labeling.getLabelRef();

	//マーカーホルダをリセット
	o_marker_list.reset();
//	marker_num=0;
	xsize =width;
	ysize =height;
//	マーカーをmarker_holderに蓄積する。
	NyARMarker current_marker=o_marker_list.getCurrentHolder();
	NyARLabel label_pt;
	for(i=0; i<label_num; i++ ){
	    label_pt=labels[i];
	    if( label_pt.area < AR_AREA_MIN || label_pt.area > AR_AREA_MAX ){
		continue;
	    }
	    if( label_pt.clip0 == 1 || label_pt.clip1 == xsize-2 ){//if( wclip[i*4+0] == 1 || wclip[i*4+1] == xsize-2 ){
		continue;
	    }
	    if( label_pt.clip2 == 1 || label_pt.clip3 == ysize-2 ){//if( wclip[i*4+2] == 1 || wclip[i*4+3] == ysize-2 ){
		continue;
	    }
	    //ret = arGetContour( limage, label_ref, i+1,&(wclip[i*4]), &(marker_info2[marker_num2]));
	    arGetContour(current_marker,limage, label_ref, i+1,label_pt);

	    if(!current_marker.checkSquare(label_pt.area,i_factor,label_pt.pos_x,label_pt.pos_y)){
		//後半で整理するからここはいらない。//        	marker_holder[marker_num2]=null;
		continue;
	    }
//	    この3行はcheckSquareの最終段に含める。
//	    marker_holder[marker_num2].area   = warea[i];
//	    marker_holder[marker_num2].pos[0] = wpos[i*2+0];
//	    marker_holder[marker_num2].pos[1] = wpos[i*2+1];
	    //マーカー検出→次のホルダを取得
	    current_marker=o_marker_list.getNextHolder();
	    //マーカーリストが上限に達したか確認
	    if(current_marker==null){
		break;
	    }
	}
	//マーカーリストを整理(重なり処理とかはマーカーリストに責務押し付け)
	o_marker_list.updateMarkerArray();
//	重なり処理かな？
//	double[] pos_j,pos_i;
//	for(i=0; i < marker_num2; i++ ){
//	    pos_i=marker_holder[i].pos;
//	    for(j=i+1; j < marker_num2; j++ ) {
//		pos_j=marker_holder[j].pos;
//		d = (pos_i[0] - pos_j[0])*(pos_i[0] - pos_j[0])+
//		(pos_i[1] - pos_j[1])*(pos_i[1] - pos_j[1]);
//		if(marker_holder[i].area >marker_holder[j].area ) {
//		    if( d <marker_holder[i].area / 4 ) {
//			marker_holder[j].area = 0;
//		    }
//		}else{
//		    if( d < marker_holder[j].area / 4 ) {
//			marker_holder[i].area = 0;
//		    }
//		}
//	    }
//	}
//	みつかったマーカーを整理する。
//	エリアが0のマーカーを外した配列を作って、その数もついでに計算
//	for(i=0;i<marker_num2;i++){
//	    if(marker_holder[i].area==0.0){
//		continue;
//	    }
//	    marker_info2_array[marker_num]=marker_holder[i];
//	    marker_num++;
//	}        
//	for( i=0; i < marker_num2; i++ ) {
//	if( marker_info2_array[i].area == 0.0 ) {
//	for( j=i+1; j < marker_num2; j++ ){
//	marker_info2_array[j-1] = marker_info2_array[j];
//	}
//	marker_num2--;
//	}
//	}
//	発見したマーカー数をセット
//	marker_num=marker_num2;//*marker_num = marker_num2;
//	return( &(marker_info2[0]) );
	return;
    }

}
