--- /dev/null
+/* \r
+ * PROJECT: NyARToolkit\r
+ * --------------------------------------------------------------------------------\r
+ * This work is based on the original ARToolKit developed by\r
+ * Hirokazu Kato\r
+ * Mark Billinghurst\r
+ * HITLab, University of Washington, Seattle\r
+ * http://www.hitl.washington.edu/artoolkit/\r
+ *\r
+ * The NyARToolkit is Java version ARToolkit class library.\r
+ * Copyright (C)2008 R.Iizuka\r
+ *\r
+ * This program is free software; you can redistribute it and/or\r
+ * modify it under the terms of the GNU General Public License\r
+ * as published by the Free Software Foundation; either version 2\r
+ * of the License, or (at your option) any later version.\r
+ * \r
+ * This program is distributed in the hope that it will be useful,\r
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of\r
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the\r
+ * GNU General Public License for more details.\r
+ * \r
+ * You should have received a copy of the GNU General Public License\r
+ * along with this framework; if not, write to the Free Software\r
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA\r
+ * \r
+ * For further information please contact.\r
+ * http://nyatla.jp/nyatoolkit/\r
+ * <airmail(at)ebony.plala.or.jp>\r
+ * \r
+ */\r
+package jp.nyatla.nyartoolkit.core;\r
+\r
+import jp.nyatla.nyartoolkit.NyARException;\r
+import jp.nyatla.nyartoolkit.core.raster.NyARRaster;\r
+\r
+/**\r
+ * 24ビットカラーのマーカーを保持するために使うクラスです。\r
+ * このクラスは、ARToolkitのパターンと、ラスタから取得したパターンを保持します。\r
+ * 演算順序以外の最適化をしたもの\r
+ *\r
+ */\r
+public class NyARColorPatt_O1 implements NyARColorPatt\r
+{\r
+ private static final int AR_PATT_SAMPLE_NUM=64;//#define AR_PATT_SAMPLE_NUM 64\r
+ private int extpat[][][];\r
+ private int width;\r
+ private int height;\r
+ public NyARColorPatt_O1(int i_width,int i_height)\r
+ {\r
+ this.width =i_width;\r
+ this.height=i_height;\r
+ this.extpat=new int[i_height][i_width][3];\r
+ this.wk_pickFromRaster_ext_pat2=new int[i_height][i_width][3];\r
+ }\r
+// public void setSize(int i_new_width,int i_new_height)\r
+// {\r
+// int array_w=this.extpat[0].length;\r
+// int array_h=this.extpat.length;\r
+// //十分なサイズのバッファがあるか確認\r
+// if(array_w>=i_new_width && array_h>=i_new_height){\r
+// //OK 十分だ→サイズ調整のみ\r
+// }else{\r
+// //足りないよ→取り直し\r
+// this.wk_pickFromRaster_ext_pat2=new int[i_new_height][i_new_width][3];\r
+// this.extpat=new int[i_new_height][i_new_width][3];\r
+// }\r
+// this.width =i_new_width;\r
+// this.height=i_new_height;\r
+// return; \r
+// }\r
+ \r
+ public int[][][] getPatArray()\r
+ {\r
+ return extpat;\r
+ }\r
+ public int getWidth()\r
+ {\r
+ return width;\r
+ }\r
+ public int getHeight()\r
+ {\r
+ return height;\r
+ }\r
+ private final NyARMat wk_get_cpara_a=new NyARMat(8,8);\r
+ private final NyARMat wk_get_cpara_b=new NyARMat(8,1);\r
+ private final NyARMat wk_get_cpara_c=new NyARMat(8,1);\r
+ /**\r
+ * \r
+ * @param world\r
+ * @param vertex\r
+ * @param para\r
+ * [3x3]\r
+ * @throws NyARException\r
+ */\r
+ private boolean get_cpara( double world[][], double vertex[][],double[] para) throws NyARException\r
+ {\r
+ NyARMat a =wk_get_cpara_a;//次処理で値を設定するので、初期化不要// new NyARMat( 8, 8 );\r
+ double[][] a_array=a.getArray();\r
+ NyARMat b =wk_get_cpara_b;//次処理で値を設定するので、初期化不要// new NyARMat( 8, 1 );\r
+ double[][] b_array=b.getArray();\r
+ double[] a_pt0,a_pt1,world_pti;\r
+\r
+ for(int i = 0; i < 4; i++ ) {\r
+ a_pt0=a_array[i*2];\r
+ a_pt1=a_array[i*2+1];\r
+ world_pti=world[i];\r
+ \r
+ a_pt0[0]=world_pti[0];//a->m[i*16+0] = world[i][0];\r
+ a_pt0[1]=world_pti[1];//a->m[i*16+1] = world[i][1];\r
+ a_pt0[2]=1.0;//a->m[i*16+2] = 1.0;\r
+ a_pt0[3]=0.0;//a->m[i*16+3] = 0.0;\r
+ a_pt0[4]=0.0;//a->m[i*16+4] = 0.0;\r
+ a_pt0[5]=0.0;//a->m[i*16+5] = 0.0;\r
+ a_pt0[6]=-world_pti[0] * vertex[i][0];//a->m[i*16+6] = -world[i][0] * vertex[i][0];\r
+ a_pt0[7]=-world_pti[1] * vertex[i][0];//a->m[i*16+7] = -world[i][1] * vertex[i][0];\r
+ a_pt1[0]=0.0;//a->m[i*16+8] = 0.0;\r
+ a_pt1[1]=0.0;//a->m[i*16+9] = 0.0;\r
+ a_pt1[2]=0.0;//a->m[i*16+10] = 0.0;\r
+ a_pt1[3]=world_pti[0];//a->m[i*16+11] = world[i][0];\r
+ a_pt1[4]=world_pti[1];//a->m[i*16+12] = world[i][1];\r
+ a_pt1[5]=1.0;//a->m[i*16+13] = 1.0;\r
+ a_pt1[6]=-world_pti[0] * vertex[i][1];//a->m[i*16+14] = -world[i][0] * vertex[i][1];\r
+ a_pt1[7]=-world_pti[1] * vertex[i][1];//a->m[i*16+15] = -world[i][1] * vertex[i][1];\r
+ b_array[i*2+0][0]=vertex[i][0];//b->m[i*2+0] = vertex[i][0];\r
+ b_array[i*2+1][0]=vertex[i][1];//b->m[i*2+1] = vertex[i][1];\r
+ }\r
+// JartkException.trap("未チェックのパス");\r
+ if(!a.matrixSelfInv()){\r
+ return false;//逆行列を求められないので失敗\r
+ }\r
+ \r
+// JartkException.trap("未チェックのパス");\r
+ NyARMat c = wk_get_cpara_c;//次処理で結果を受け取るので、初期化不要//new NyARMat( 8, 1 );\r
+ double[][] c_array=c.getArray();\r
+\r
+ c.matrixMul(a, b);\r
+ for(int i = 0; i < 2; i++ ) {\r
+ para[i*3+0] = c_array[i*3+0][0];//para[i][0] = c->m[i*3+0];\r
+ para[i*3+1] = c_array[i*3+1][0];//para[i][1] = c->m[i*3+1];\r
+ para[i*3+2] = c_array[i*3+2][0];//para[i][2] = c->m[i*3+2];\r
+ }\r
+ para[2*3+0] = c_array[2*3+0][0];//para[2][0] = c->m[2*3+0];\r
+ para[2*3+1] = c_array[2*3+1][0];//para[2][1] = c->m[2*3+1];\r
+ para[2*3+2] = 1.0;//para[2][2] = 1.0;\r
+ return true;\r
+ }\r
+\r
+ private final double[][] wk_pickFromRaster_local=new double[4][2];\r
+ private final double[] wk_pickFromRaster_para=new double[9];//[3][3];\r
+ private int[][][] wk_pickFromRaster_ext_pat2=null;//コンストラクタでint[height][width][3]を作る\r
+ private final double[][] wk_pickFromRaster_world={//double world[4][2];\r
+ {100.0, 100.0},\r
+ {100.0+10.0,100.0},\r
+ {100.0+10.0,100.0 + 10.0},\r
+ {100.0, 100.0 + 10.0}\r
+ };\r
+ /**\r
+ * pickFromRaster関数から使う変数です。\r
+ *\r
+ */\r
+ private static void initValue_wk_pickFromRaster_ext_pat2(int[][][] i_ext_pat2,int i_width,int i_height)\r
+ {\r
+ int i,i2;\r
+ int[][] pt2;\r
+ int[] pt1;\r
+ for(i=i_height-1;i>=0;i--){\r
+ pt2=i_ext_pat2[i];\r
+ for(i2=i_width-1;i2>=0;i2--){\r
+ pt1=pt2[i2];\r
+ pt1[0]=0;\r
+ pt1[1]=0;\r
+ pt1[2]=0;\r
+ }\r
+ }\r
+ }\r
+ private final int[] wk_pickFromRaster_rgb_tmp=new int[3];\r
+ /**\r
+ * imageから、i_markerの位置にあるパターンを切り出して、保持します。\r
+ * Optimize:STEP[769->]\r
+ * @param image\r
+ * @param i_marker\r
+ * @return\r
+ * 切り出しに失敗した\r
+ * @throws Exception\r
+ */\r
+ public boolean pickFromRaster(NyARRaster image, NyARMarker i_marker) throws NyARException\r
+ {\r
+ double d, xw, yw;\r
+ int xc, yc;\r
+ int xdiv, ydiv;\r
+ int xdiv2, ydiv2;\r
+ int lx1, lx2, ly1, ly2;\r
+\r
+ int img_x=image.getWidth();\r
+ int img_y=image.getHeight();\r
+\r
+ double xdiv2_reciprocal; // [tp]\r
+ double ydiv2_reciprocal; // [tp]\r
+\r
+\r
+ int[] x_coord=i_marker.x_coord;\r
+ int[] y_coord=i_marker.y_coord;\r
+ double[][] local=wk_pickFromRaster_local;//double local[4][2]; \r
+ int[] vertex=i_marker.mkvertex;\r
+ for(int i = 0; i < 4; i++ ) {\r
+ local[i][0] = x_coord[vertex[i]];\r
+ local[i][1] = y_coord[vertex[i]];\r
+ }\r
+ double[][] world=wk_pickFromRaster_world;\r
+/* world[0][0] = 100.0;\r
+ world[0][1] = 100.0;\r
+ world[1][0] = 100.0 + 10.0;\r
+ world[1][1] = 100.0;\r
+ world[2][0] = 100.0 + 10.0;\r
+ world[2][1] = 100.0 + 10.0;\r
+ world[3][0] = 100.0;\r
+ world[3][1] = 100.0 + 10.0;*/\r
+ double[] para =wk_pickFromRaster_para; //double para[3][3];\r
+ //パターンの切り出しに失敗することもある。\r
+ if(!get_cpara( world, local, para )){\r
+ return false;\r
+ }\r
+ lx1 = (int)((local[0][0] - local[1][0])*(local[0][0] - local[1][0])+ (local[0][1] - local[1][1])*(local[0][1] - local[1][1]));\r
+ lx2 = (int)((local[2][0] - local[3][0])*(local[2][0] - local[3][0])+ (local[2][1] - local[3][1])*(local[2][1] - local[3][1]));\r
+ ly1 = (int)((local[1][0] - local[2][0])*(local[1][0] - local[2][0])+ (local[1][1] - local[2][1])*(local[1][1] - local[2][1]));\r
+ ly2 = (int)((local[3][0] - local[0][0])*(local[3][0] - local[0][0])+ (local[3][1] - local[0][1])*(local[3][1] - local[0][1]));\r
+ if( lx2 > lx1 ){\r
+ lx1 = lx2;\r
+ }\r
+ if( ly2 > ly1 ){\r
+ ly1 = ly2;\r
+ }\r
+ xdiv2 =this.width;\r
+ ydiv2 =this.height;\r
+\r
+ while( xdiv2*xdiv2 < lx1/4 ){\r
+ xdiv2*=2;\r
+ }\r
+ while( ydiv2*ydiv2 < ly1/4 ){\r
+ ydiv2*=2;\r
+ }\r
+\r
+ if( xdiv2 > AR_PATT_SAMPLE_NUM)\r
+ {\r
+ xdiv2 =AR_PATT_SAMPLE_NUM;\r
+ }\r
+ if( ydiv2 >AR_PATT_SAMPLE_NUM)\r
+ {\r
+ ydiv2 = AR_PATT_SAMPLE_NUM;\r
+ }\r
+\r
+ xdiv = xdiv2/width;//xdiv = xdiv2/Config.AR_PATT_SIZE_X;\r
+ ydiv = ydiv2/height;//ydiv = ydiv2/Config.AR_PATT_SIZE_Y;\r
+\r
+ /*wk_pickFromRaster_ext_pat2ワーク変数を初期化する。*/\r
+ int[][][] ext_pat2=wk_pickFromRaster_ext_pat2;//ARUint32 ext_pat2[AR_PATT_SIZE_Y][AR_PATT_SIZE_X][3];\r
+ int extpat_j[][],extpat_j_i[];\r
+ int ext_pat2_j[][],ext_pat2_j_i[];\r
+\r
+ initValue_wk_pickFromRaster_ext_pat2(ext_pat2,this.width,this.height);\r
+\r
+ xdiv2_reciprocal = 1.0 / xdiv2;\r
+ ydiv2_reciprocal = 1.0 / ydiv2;\r
+ int i,j;\r
+ int[] rgb_tmp=wk_pickFromRaster_rgb_tmp;\r
+ // arGetCode_put_zero(ext_pat2);//put_zero( (ARUint8 *)ext_pat2, AR_PATT_SIZE_Y*AR_PATT_SIZE_X*3*sizeof(ARUint32) );\r
+ for(j = 0; j < ydiv2; j++ ) {\r
+ yw = 102.5 + 5.0 * (j+0.5) * ydiv2_reciprocal;\r
+ for(i = 0; i < xdiv2; i++ ) {\r
+ xw = 102.5 + 5.0 * (i+0.5) * xdiv2_reciprocal;\r
+ d = para[2*3+0]*xw + para[2*3+1]*yw + para[2*3+2];\r
+ if( d == 0 ){\r
+ throw new NyARException();\r
+ }\r
+ xc = (int)((para[0*3+0]*xw + para[0*3+1]*yw + para[0*3+2])/d);\r
+ yc = (int)((para[1*3+0]*xw + para[1*3+1]*yw + para[1*3+2])/d);\r
+\r
+\r
+ if( xc >= 0 && xc < img_x && yc >= 0 && yc < img_y ) {\r
+ image.getPixel(xc, yc, rgb_tmp);\r
+ ext_pat2_j_i=ext_pat2[j/ydiv][i/xdiv];\r
+\r
+ ext_pat2_j_i[0] += rgb_tmp[0];//R\r
+ ext_pat2_j_i[1] += rgb_tmp[1];//G\r
+ ext_pat2_j_i[2] += rgb_tmp[2];//B\r
+// System.out.println(xc+":"+yc+":"+rgb_tmp[0]+":"+rgb_tmp[1]+":"+rgb_tmp[2]);\r
+ }\r
+ }\r
+ }\r
+// short[][][] ext_pat=new short[Config.AR_PATT_SIZE_Y][Config.AR_PATT_SIZE_X][3];//ARUint32 ext_pat2[AR_PATT_SIZE_Y][AR_PATT_SIZE_X][3];\r
+ /*<Optimize>*/\r
+ int xdiv_x_ydiv=xdiv*ydiv;\r
+ for(j = this.height-1; j>=0; j--){\r
+ extpat_j=extpat[j];\r
+ ext_pat2_j=ext_pat2[j];\r
+ for(i = this.width-1; i>=0; i--){ // PRL 2006-06-08.\r
+ ext_pat2_j_i=ext_pat2_j[i];\r
+ extpat_j_i=extpat_j[i];\r
+ extpat_j_i[0]=(ext_pat2_j_i[0] / xdiv_x_ydiv);//ext_pat[j][i][0] = (byte)(ext_pat2[j][i][0] / (xdiv*ydiv));\r
+ extpat_j_i[1]=(ext_pat2_j_i[1] / xdiv_x_ydiv);//ext_pat[j][i][1] = (byte)(ext_pat2[j][i][1] / (xdiv*ydiv));\r
+ extpat_j_i[2]=(ext_pat2_j_i[2] / xdiv_x_ydiv);//ext_pat[j][i][2] = (byte)(ext_pat2[j][i][2] / (xdiv*ydiv));\r
+ }\r
+ }/*\r
+ int xdiv_mul_ydiv=xdiv*ydiv;\r
+ short [][] extpat_pt_2;\r
+ short[] extpat_pt_1;\r
+ int[][] ext_pat2_pt_2;\r
+ int[] ext_pat2_pt_1;\r
+ for(int j=this.height-1; j>=0; j--){//for(int j = 0; j < this.height; j++ ){\r
+ extpat_pt_2=extpat[j];\r
+ ext_pat2_pt_2=ext_pat2[j];\r
+ for(int i = this.width-1; i>=0; i--){//for(int i = 0; i < this.width; i++ ){ // PRL 2006-06-08.\r
+ extpat_pt_1=extpat_pt_2[i];\r
+ ext_pat2_pt_1=ext_pat2_pt_2[i]; \r
+ extpat_pt_1[0]=(short)(ext_pat2_pt_1[0] / xdiv_mul_ydiv);//ext_pat[j][i][0] = (byte)(ext_pat2[j][i][0] / (xdiv*ydiv));\r
+ extpat_pt_1[1]=(short)(ext_pat2_pt_1[1] / xdiv_mul_ydiv);//ext_pat[j][i][1] = (byte)(ext_pat2[j][i][1] / (xdiv*ydiv));\r
+ extpat_pt_1[2]=(short)(ext_pat2_pt_1[2] / xdiv_mul_ydiv);//ext_pat[j][i][2] = (byte)(ext_pat2[j][i][2] / (xdiv*ydiv));\r
+ }\r
+ }\r
+ /*</Optimize>*/\r
+ return true;\r
+ }\r
+}
\ No newline at end of file
OSDN Git Service
