[backup]NyARToolkit for Java

[nyartoolkit-and/nyartoolkit-and.git] / trunk / src / jp / nyatla / nyartoolkit / core / squaredetect / Coord2SquareVertexIndexes.java

diff --git a/trunk/src/jp/nyatla/nyartoolkit/core/squaredetect/Coord2SquareVertexIndexes.java b/trunk/src/jp/nyatla/nyartoolkit/core/squaredetect/Coord2SquareVertexIndexes.java
index 47e8806..8a6ea35 100644 (file)
--- a/trunk/src/jp/nyatla/nyartoolkit/core/squaredetect/Coord2SquareVertexIndexes.java
+++ b/trunk/src/jp/nyatla/nyartoolkit/core/squaredetect/Coord2SquareVertexIndexes.java
@@ -31,7 +31,7 @@
 package jp.nyatla.nyartoolkit.core.squaredetect;\r
 \r
 /**\r
- * 座標店集合（輪郭線）から、頂点リストを計算します。\r
+ * 座標店集合（輪郭線）から、四角系の頂点候補点を計算します。\r
  *\r
  */\r
 public class Coord2SquareVertexIndexes\r
@@ -157,4 +157,99 @@ public class Coord2SquareVertexIndexes
                }               \r
                return ret;\r
        }       \r
+}\r
+\r
+\r
+\r
+\r
+/**\r
+ * get_vertex関数を切り離すためのクラス\r
+ * \r
+ */\r
+final class NyARVertexCounter\r
+{\r
+       public final int[] vertex = new int[10];// 6まで削れる\r
+\r
+       public int number_of_vertex;\r
+\r
+       private double thresh;\r
+\r
+       private int[] x_coord;\r
+\r
+       private int[] y_coord;\r
+\r
+       public boolean getVertex(int[] i_x_coord, int[] i_y_coord,int i_coord_len,int st, int ed, double i_thresh)\r
+       {\r
+               this.number_of_vertex = 0;\r
+               this.thresh = i_thresh;\r
+               this.x_coord = i_x_coord;\r
+               this.y_coord = i_y_coord;\r
+               return get_vertex(st, ed,i_coord_len);\r
+       }\r
+\r
+       /**\r
+        * static int get_vertex( int x_coord[], int y_coord[], int st, int ed,double thresh, int vertex[], int *vnum) 関数の代替関数\r
+        * \r
+        * @param x_coord\r
+        * @param y_coord\r
+        * @param st\r
+        * @param ed\r
+        * @param thresh\r
+        * @return\r
+        */\r
+       private boolean get_vertex(int st, int ed,int i_coord_len)\r
+       {\r
+               //メモ:座標値は65536を超えなければint32で扱って大丈夫なので変更。\r
+               //dmaxは4乗なのでやるとしてもint64じゃないとマズイ\r
+               int v1 = 0;\r
+               final int[] lx_coord = this.x_coord;\r
+               final int[] ly_coord = this.y_coord;\r
+               final int a = ly_coord[ed] - ly_coord[st];\r
+               final int b = lx_coord[st] - lx_coord[ed];\r
+               final int c = lx_coord[ed] * ly_coord[st] - ly_coord[ed] * lx_coord[st];\r
+               double dmax = 0;\r
+               if(st<ed){\r
+                       //stとedが1区間\r
+                       for (int i = st + 1; i < ed; i++) {\r
+                               final double d = a * lx_coord[i] + b * ly_coord[i] + c;\r
+                               if (d * d > dmax) {\r
+                                       dmax = d * d;\r
+                                       v1 = i;\r
+                               }\r
+                       }\r
+               }else{\r
+                       //stとedが2区間\r
+                       for (int i = st + 1; i < i_coord_len; i++) {\r
+                               final double d = a * lx_coord[i] + b * ly_coord[i] + c;\r
+                               if (d * d > dmax) {\r
+                                       dmax = d * d;\r
+                                       v1 = i;\r
+                               }\r
+                       }\r
+                       for (int i = 0; i < ed; i++) {\r
+                               final double d = a * lx_coord[i] + b * ly_coord[i] + c;\r
+                               if (d * d > dmax) {\r
+                                       dmax = d * d;\r
+                                       v1 = i;\r
+                               }\r
+                       }\r
+               }\r
+\r
+               \r
+               if (dmax / (double)(a * a + b * b) > thresh) {\r
+                       if (!get_vertex(st, v1,i_coord_len)) {\r
+                               return false;\r
+                       }\r
+                       if (number_of_vertex > 5) {\r
+                               return false;\r
+                       }\r
+                       vertex[number_of_vertex] = v1;// vertex[(*vnum)] = v1;\r
+                       number_of_vertex++;// (*vnum)++;\r
+\r
+                       if (!get_vertex(v1, ed,i_coord_len)) {\r
+                               return false;\r
+                       }\r
+               }\r
+               return true;\r
+       }\r
 }
\ No newline at end of file