OSDN Git Service

[backup]NyARToolkitCS/2.4.2
[nyartoolkit-and/nyartoolkit-and.git] / src / jp / nyatla / nyartoolkit / utils / TransformedBitmapPickup.java
1 package jp.nyatla.nyartoolkit.utils;\r
2 \r
3 import jp.nyatla.nyartoolkit.NyARException;\r
4 import jp.nyatla.nyartoolkit.core.param.NyARPerspectiveProjectionMatrix;\r
5 import jp.nyatla.nyartoolkit.core.pickup.NyARColorPatt_Perspective_O2;\r
6 import jp.nyatla.nyartoolkit.core.raster.rgb.INyARRgbRaster;\r
7 import jp.nyatla.nyartoolkit.core.transmat.NyARTransMatResult;\r
8 import jp.nyatla.nyartoolkit.core.types.NyARIntPoint2d;\r
9 \r
10 /**\r
11  * マーカの周辺領域からビットマップを取得する方法を提供します。\r
12  * 比較的負荷が大きいので、連続してパターンを取得し続ける用途には向いていません。\r
13  *\r
14  */\r
15 class TransformedBitmapPickup extends NyARColorPatt_Perspective_O2\r
16 {\r
17         private NyARIntPoint2d[] _work_points = NyARIntPoint2d.createArray(4);\r
18 \r
19         private NyARPerspectiveProjectionMatrix _ref_perspective;\r
20 \r
21         /**\r
22          * \r
23          * @param i_width\r
24          * 取得するビットマップの幅\r
25          * @param i_height\r
26          * 取得するビットマップの解像度\r
27          * @param i_resolution\r
28          * resolution of reading pixel per point. ---- 取得時の解像度。高解像度のときは1を指定してください。低解像度のときは2以上を指定します。\r
29          */\r
30         TransformedBitmapPickup(NyARPerspectiveProjectionMatrix i_ref_cparam, int i_width, int i_height, int i_resolution)\r
31         {\r
32                 super(i_width, i_height, i_resolution, 0);\r
33                 this._ref_perspective = i_ref_cparam;\r
34         }\r
35 \r
36         /**\r
37          * This function retrieves bitmap from the area defined by RECT(i_l,i_t,i_r,i_b) above transform matrix i_base_mat. \r
38          * ----\r
39          * この関数は、basementで示される平面のAで定義される領域から、ビットマップを読み出します。\r
40          * 例えば、8cmマーカでRECT(i_l,i_t,i_r,i_b)に-40,0,0,-40.0を指定すると、マーカの左下部分の画像を抽出します。\r
41          * \r
42          * マーカから離れた場所になるほど、また、マーカの鉛直方向から外れるほど誤差が大きくなります。\r
43          * @param i_src_imege\r
44          * 詠み出し元の画像を指定します。\r
45          * @param i_l\r
46          * 基準点からの左上の相対座標(x)を指定します。\r
47          * @param i_t\r
48          * 基準点からの左上の相対座標(y)を指定します。\r
49          * @param i_r\r
50          * 基準点からの右下の相対座標(x)を指定します。\r
51          * @param i_b\r
52          * 基準点からの右下の相対座標(y)を指定します。\r
53          * @param i_base_mat\r
54          * @return 画像の取得の成否を返す。\r
55          */\r
56         public boolean pickupImage2d(INyARRgbRaster i_src_imege, double i_l, double i_t, double i_r, double i_b, NyARTransMatResult i_base_mat) throws NyARException\r
57         {\r
58                 double cp00, cp01, cp02, cp11, cp12;\r
59                 cp00 = this._ref_perspective.m00;\r
60                 cp01 = this._ref_perspective.m01;\r
61                 cp02 = this._ref_perspective.m02;\r
62                 cp11 = this._ref_perspective.m11;\r
63                 cp12 = this._ref_perspective.m12;\r
64                 //マーカと同一平面上にある矩形の4個の頂点を座標変換して、射影変換して画面上の\r
65                 //頂点を計算する。\r
66                 //[hX,hY,h]=[P][RT][x,y,z]\r
67 \r
68                 //出力先\r
69                 NyARIntPoint2d[] poinsts = this._work_points;           \r
70                 \r
71                 double yt0,yt1,yt2;\r
72                 double x3, y3, z3;\r
73                 \r
74                 double m00=i_base_mat.m00;\r
75                 double m10=i_base_mat.m10;\r
76                 double m20=i_base_mat.m20;\r
77                 \r
78                 //yとtの要素を先に計算\r
79                 yt0=i_base_mat.m01 * i_t+i_base_mat.m03;\r
80                 yt1=i_base_mat.m11 * i_t+i_base_mat.m13;\r
81                 yt2=i_base_mat.m21 * i_t+i_base_mat.m23;\r
82                 // l,t\r
83                 x3 = m00 * i_l + yt0;\r
84                 y3 = m10 * i_l + yt1;\r
85                 z3 = m20 * i_l + yt2;\r
86                 poinsts[0].x = (int) ((x3 * cp00 + y3 * cp01 + z3 * cp02) / z3);\r
87                 poinsts[0].y = (int) ((y3 * cp11 + z3 * cp12) / z3);\r
88                 // r,t\r
89                 x3 = m00 * i_r + yt0;\r
90                 y3 = m10 * i_r + yt1;\r
91                 z3 = m20 * i_r + yt2;\r
92                 poinsts[1].x = (int) ((x3 * cp00 + y3 * cp01 + z3 * cp02) / z3);\r
93                 poinsts[1].y = (int) ((y3 * cp11 + z3 * cp12) / z3);\r
94 \r
95                 //yとtの要素を先に計算\r
96                 yt0=i_base_mat.m01 * i_b+i_base_mat.m03;\r
97                 yt1=i_base_mat.m11 * i_b+i_base_mat.m13;\r
98                 yt2=i_base_mat.m21 * i_b+i_base_mat.m23;\r
99 \r
100                 // r,b\r
101                 x3 = m00 * i_r + yt0;\r
102                 y3 = m10 * i_r + yt1;\r
103                 z3 = m20 * i_r + yt2;\r
104                 poinsts[2].x = (int) ((x3 * cp00 + y3 * cp01 + z3 * cp02) / z3);\r
105                 poinsts[2].y = (int) ((y3 * cp11 + z3 * cp12) / z3);\r
106                 // l,b\r
107                 x3 = m00 * i_l + yt0;\r
108                 y3 = m10 * i_l + yt1;\r
109                 z3 = m20 * i_l + yt2;\r
110                 poinsts[3].x = (int) ((x3 * cp00 + y3 * cp01 + z3 * cp02) / z3);\r
111                 poinsts[3].y = (int) ((y3 * cp11 + z3 * cp12) / z3);\r
112                 return this.pickFromRaster(i_src_imege, poinsts);\r
113         }\r
114 }