Subversion Repositories AndroidProjects

/*

 * 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;

/**

 * typedef struct {

 *      int     area;

 *      double  pos[2];

 *      int     coord_num;

 *      int     x_coord[AR_CHAIN_MAX];

 *      int     y_coord[AR_CHAIN_MAX];

 *      int     vertex[5];

 * } ARMarkerInfo2;

 *

 */

class NyARMarker

{

    /**

     * メモリブロックのサイズ(32*4=128kb)

     */

    private static final int ALLOCATE_PAGE_SIZE=256;

    /**

     * メモリブロックの初期サイズ

     */

    private static final int INITIAL_SIZE=1;

    int[]       x_coord=new int[INITIAL_SIZE];

    int[]       y_coord=new int[INITIAL_SIZE];

    int         coord_num;

    int         area;

    final double[] pos=new double[2];

    final int[] mkvertex=new int[5];

    /**

     * coordバッファをi_chain_num以上のサイズに再アロケートする。

     * 内容の引継ぎは行われない。

     * @param i_chain_num

     */

    private void reallocCoordArray(int i_chain_num)

    {

        if(x_coord.length<i_chain_num){

            //ALLOCATE_PAGE_SIZE単位で確保する。

            int new_size=((i_chain_num+ALLOCATE_PAGE_SIZE-1)/ALLOCATE_PAGE_SIZE)*ALLOCATE_PAGE_SIZE;

            x_coord=new int[new_size];

            y_coord=new int[new_size];

            coord_num=0;

        }

    }

    public void setCoordXY(int i_v1,int i_coord_num,int[] i_xcoord,int[] i_ycoord)

    {

        //メモリの割り当て保障

        reallocCoordArray(i_coord_num+1);

        //[A B C]を[B C A]に並べなおす。

        System.arraycopy(i_xcoord,i_v1,x_coord,0,i_coord_num-i_v1);

        System.arraycopy(i_xcoord,0,x_coord,i_coord_num-i_v1, i_v1);

        x_coord[i_coord_num]=x_coord[0];

        System.arraycopy(i_ycoord,i_v1,y_coord,0,i_coord_num-i_v1);

        System.arraycopy(i_ycoord,0,y_coord,i_coord_num-i_v1, i_v1);

        y_coord[i_coord_num]=y_coord[0];

        coord_num=i_coord_num+1;

        return;

//arGetContour関数から取り外した部分 

//      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++;

    }

    private final NyARVertexCounter wk_checkSquare_wv1=new NyARVertexCounter();

    private final NyARVertexCounter wk_checkSquare_wv2=new NyARVertexCounter();

    /**

     * static int arDetectMarker2_check_square( int area, ARMarkerInfo2 *marker_info2, double factor )

     * 関数の代替関数

     * OPTIMIZED STEP [450->415]

     * @param i_area

     * @param i_factor

     * @return

     */

    public boolean checkSquare(int i_area,double i_factor,double i_pos_x,double i_pos_y)

    {

        final int[] l_vertex=mkvertex;

        final int[] l_x_coord=x_coord;

        final int[] l_y_coord=y_coord;

        final NyARVertexCounter wv1=wk_checkSquare_wv1;

        final NyARVertexCounter wv2=wk_checkSquare_wv2;

        int             sx,sy;

        int             dmax,d,v1;

        int v2;//           int   wvnum1,wvnum2,v2;

        int i;

        final int L_coord_num_m1=this.coord_num-1;

        dmax = 0;

        v1 = 0;

        sx = l_x_coord[0];//sx = marker_info2->x_coord[0];

        sy = l_y_coord[0];//sy = marker_info2->y_coord[0];

        for(i=1;i<L_coord_num_m1;i++){//for(i=1;i<marker_info2->coord_num-1;i++) {

            d = (l_x_coord[i]-sx)*(l_x_coord[i]-sx)+ (l_y_coord[i]-sy)*(l_y_coord[i]-sy);

            if( d > dmax ) {

                dmax = d;

                v1 = i;

            }

        }

        final double thresh = (i_area/0.75) * 0.01 * i_factor;

        l_vertex[0] = 0;

        if(!wv1.getVertex(l_x_coord,l_y_coord, 0,  v1,thresh)){     //if( get_vertex(marker_info2->x_coord, marker_info2->y_coord, 0,  v1,thresh, wv1, &wvnum1) < 0 ) {

            return false;

        }

        if(!wv2.getVertex(l_x_coord,l_y_coord,v1,L_coord_num_m1, thresh)) {//if(get_vertex(marker_info2->x_coord, marker_info2->y_coord,v1,  marker_info2->coord_num-1, thresh, wv2, &wvnum2) < 0 ) {

            return false;

        }

        if(wv1.number_of_vertex==1 && wv2.number_of_vertex==1) {//if( wvnum1 == 1 && wvnum2 == 1 ) {

            l_vertex[1] = wv1.vertex[0];

            l_vertex[2] = v1;

            l_vertex[3] = wv2.vertex[0];

        }else if( wv1.number_of_vertex>1 && wv2.number_of_vertex==0 ) {//}else if( wvnum1 > 1 && wvnum2 == 0 ) {

            v2 = v1 / 2;

            if(!wv1.getVertex(l_x_coord,l_y_coord,0,  v2, thresh)) {

                return false;

            }

            if(!wv2.getVertex(l_x_coord,l_y_coord,v2,  v1, thresh)) {

                return false;

            }

            if(wv1.number_of_vertex==1 && wv2.number_of_vertex==1 ) {

                l_vertex[1] = wv1.vertex[0];

                l_vertex[2] = wv2.vertex[0];

                l_vertex[3] = v1;

            }else{

                return false;

            }

        }else if(wv1.number_of_vertex==0 && wv2.number_of_vertex> 1 ) {

            v2 = (v1 + this.coord_num-1) / 2;

            if(!wv1.getVertex(l_x_coord,l_y_coord,v1, v2, thresh)) {

                return false;

            }

            if(!wv2.getVertex(l_x_coord,l_y_coord,v2,L_coord_num_m1, thresh)) {

                return false;

            }

            if( wv1.number_of_vertex==1 && wv2.number_of_vertex==1 ) {

                l_vertex[1] = v1;

                l_vertex[2] = wv1.vertex[0];

                l_vertex[3] = wv2.vertex[0];

            }

            else {

                return false;

            }

        }

        else {

            return false;

        }

        l_vertex[4] =L_coord_num_m1;//この値使ってるの？

        //

        area   = i_area;

        pos[0] = i_pos_x;

        pos[1] = i_pos_y;

//      marker_holder[marker_num2].pos[1] = wpos[i*2+1];        

        return true;

    }        

}

/**

 * get_vertex関数を切り離すためのクラス

 *

 */

final class NyARVertexCounter

{

    public final int[] vertex=new int[10];//5まで削れる

    public int number_of_vertex;

    private double thresh;

    private int[] x_coord;

    private int[] y_coord;

    public boolean getVertex(int[] i_x_coord, int[] i_y_coord, int st,  int ed,double i_thresh)

    {

        this.number_of_vertex=0;

        this.thresh=i_thresh;

        this.x_coord=i_x_coord;

        this.y_coord=i_y_coord;

        return get_vertex(st,ed);

    }

    /**

     * static int get_vertex( int x_coord[], int y_coord[], int st,  int ed,double thresh, int vertex[], int *vnum)

     * 関数の代替関数

     * @param x_coord

     * @param y_coord

     * @param st

     * @param ed

     * @param thresh

     * @return

     */

    private boolean get_vertex(int st,  int ed)

    {

        double   d, dmax;

        double   a, b, c;

        int      i, v1=0;

        final int[] lx_coord=this.x_coord;

        final int[] ly_coord=this.y_coord;      

        a = ly_coord[ed] - ly_coord[st];

        b = lx_coord[st] - lx_coord[ed];

        c = lx_coord[ed]*ly_coord[st] - ly_coord[ed]*lx_coord[st];

        dmax = 0;

        for(i=st+1;i<ed;i++) {

            d = a*lx_coord[i] + b*ly_coord[i] + c;

            if( d*d > dmax ) {

                dmax = d*d;

                v1 = i;

            }

        }

        if( dmax/(a*a+b*b) > thresh ) {

            if(!get_vertex(st,  v1)){

                return false;

            }

            if(number_of_vertex > 5 ){

                return false;

            }

            vertex[number_of_vertex] = v1;//vertex[(*vnum)] = v1;

            number_of_vertex++;//(*vnum)++;

            if(!get_vertex(v1,  ed)){

                return false;

            }

        }

        return true;

    }

}