[更新]NyARToolkit for Java

[nyartoolkit-and/nyartoolkit-and.git] / trunk / src / jp / nyatla / nyartoolkit / core / transmat / NyARTransMatResult.java

diff --git a/trunk/src/jp/nyatla/nyartoolkit/core/transmat/NyARTransMatResult.java b/trunk/src/jp/nyatla/nyartoolkit/core/transmat/NyARTransMatResult.java
index 64e20a5..25b6ef7 100644 (file)
--- a/trunk/src/jp/nyatla/nyartoolkit/core/transmat/NyARTransMatResult.java
+++ b/trunk/src/jp/nyatla/nyartoolkit/core/transmat/NyARTransMatResult.java
@@ -61,5 +61,12 @@ public class NyARTransMatResult extends NyARDoubleMatrix34
                        o_out.z = Math.atan2(-this.m01, this.m11);\r
                        o_out.y = Math.atan2(-this.m20, this.m22);\r
                }\r
-       }       \r
+       }\r
+       public final void transformVertex(double i_x,double i_y,double i_z,NyARDoublePoint3d o_out)\r
+       {\r
+               o_out.x=this.m00*i_x+this.m01*i_y+this.m02*i_z+this.m03;\r
+               o_out.y=this.m10*i_x+this.m11*i_y+this.m12*i_z+this.m13;\r
+               o_out.z=this.m20*i_x+this.m21*i_y+this.m22*i_z+this.m23;\r
+               return;\r
+       }\r
 }\r