nyarvec.java

java 版的 ARToolkit

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

import jp.nyatla.nyartoolkit.NyARException;



public class NyARVec
{
	private int clm;

	public NyARVec(int i_clm)
	{
		v = new double[i_clm];
		clm = i_clm;
	}

	private double[] v;

	/**
	 * i_clmサイズの列を格納できるように列サイズを変更します。 実行後、列の各値は不定になります。
	 * 
	 * @param i_clm
	 */
	public void realloc(int i_clm)
	{
		if (i_clm <= this.v.length) {
			// 十分な配列があれば何もしない。
		} else {
			// 不十分なら取り直す。
			v = new double[i_clm];
		}
		this.clm = i_clm;
	}

	public int getClm()
	{
		return clm;
	}

	public double[] getArray()
	{
		return v;
	}

	/**
	 * arVecDispの代替品
	 * 
	 * @param value
	 * @return
	 */
	public int arVecDisp() throws NyARException
	{
		NyARException.trap("未チェックのパス");
		System.out.println(" === vector (" + clm + ") ===\n");// printf(" ===
																// vector (%d)
																// ===\n",
																// v->clm);
		System.out.print(" |");// printf(" |");
		for (int c = 0; c < clm; c++) {// for( c = 0; c < v->clm; c++ ){
			System.out.print(" " + v[c]);// printf( " %10g", v->v[c] );
		}
		System.out.println(" |");// printf(" |\n");
		System.out.println(" ===================");// printf("
													// ===================\n");
		return 0;
	}

	/**
	 * arVecInnerproduct関数の代替品
	 * 
	 * @param x
	 * @param y
	 * @param i_start
	 *            演算開始列(よくわからないけどarVecTridiagonalizeの呼び出し元でなんかしてる)
	 * @return
	 * @throws NyARException
	 */
	public double vecInnerproduct(NyARVec y, int i_start) throws NyARException
	{
		NyARException.trap("この関数は動作確認できていません。");
		double result = 0.0;
		// double[] x_array=x.v;.getArray();
		// double[] y_array=y.getArray();

		if (this.clm != y.clm) {
			throw new NyARException();// exit();
		}
		for (int i = i_start; i < this.clm; i++) {
			NyARException.trap("未チェックのパス");
			result += this.v[i] * y.v[i];// result += x->v[i] * y->v[i];
		}
		return result;
	}

	/**
	 * double arVecHousehold関数の代替品
	 * 
	 * @param x
	 * @param i_start
	 *            演算開始列(よくわからないけどarVecTridiagonalizeの呼び出し元でなんかしてる)
	 * @return
	 * @throws NyARException
	 */
	public double vecHousehold(int i_start) throws NyARException
	{
		NyARException.trap("この関数は動作確認できていません。");
		double s, t;
		s = Math.sqrt(this.vecInnerproduct(this, i_start));
		// double[] x_array=x.getArray();
		if (s != 0.0) {
			NyARException.trap("未チェックのパス");
			if (this.v[i_start] < 0) {
				s = -s;
			}
			NyARException.trap("未チェックのパス");
			{
				this.v[i_start] += s;// x->v[0] += s;
				t = 1 / Math.sqrt(this.v[i_start] * s);// t = 1 / sqrt(x->v[0] * s);
			}
			for (int i = i_start; i < this.clm; i++) {
				NyARException.trap("未チェックのパス");
				this.v[i] *= t;// x->v[i] *= t;
			}
		}
		return -s;
	}

	// /**
	// * arVecTridiagonalize関数の代替品
	// * a,d,e間で演算をしてる。何をどうしているかはさっぱりさっぱり
	// * @param a
	// * @param d
	// * @param e
	// * @param i_e_start
	// * 演算開始列(よくわからないけどarVecTridiagonalizeの呼び出し元でなんかしてる)
	// * @return
	// * @throws NyARException
	// */
	// public static void vecTridiagonalize(NyARMat a, NyARVec d, NyARVec e,int
	// i_e_start) throws NyARException
	// {
	// NyARVec vec,vec2;
	// double[][] a_array=a.getArray();
	// double s, t, p, q;
	// int dim;
	//
	// if(a.getClm()!=a.getRow()){
	// throw new NyARException();
	// }
	// if(a.getClm() != d.clm){
	// throw new NyARException();
	// }
	// if(a.getClm() != e.clm){
	// throw new NyARException();
	// }
	// dim = a.getClm();
	//
	// for(int k = 0; k < dim-2; k++ ){
	// vec=a.getRowVec(k);
	// // double[] vec_array=vec.getArray();
	// NyARException.trap("未チェックパス");
	// d.v[k]=vec.v[k];//d.set(k,v.get(k)); //d->v[k] = v[k];
	//
	// //wv1.clm = dim-k-1;
	// //wv1.v = &(v[k+1]);
	// NyARException.trap("未チェックパス");
	// e.v[k+i_e_start]=vec.vecHousehold(k+1);//e->v[k] = arVecHousehold(&wv1);
	// if(e.v[k+i_e_start]== 0.0 ){
	// continue;
	// }
	//
	// for(int i = k+1; i < dim; i++ ){
	// s = 0.0;
	// for(int j = k+1; j < i; j++ ) {
	// NyARException.trap("未チェックのパス");
	// s += a_array[j][i] * vec.v[j];//s += a.get(j*dim+i) * v.get(j);//s +=
	// a->m[j*dim+i] * v[j];
	// }
	// for(int j = i; j < dim; j++ ) {
	// NyARException.trap("未チェックのパス");
	// s += a_array[i][j] * vec.v[j];//s += a.get(i*dim+j) * v.get(j);//s +=
	// a->m[i*dim+j] * v[j];
	// }
	// NyARException.trap("未チェックのパス");
	// d.v[i]=s;//d->v[i] = s;
	// }
	//
	//
	// //wv1.clm = wv2.clm = dim-k-1;
	// //wv1.v = &(v[k+1]);
	// //wv2.v = &(d->v[k+1]);
	// vec=a.getRowVec(k);
	// // vec_array=vec.getArray();
	// NyARException.trap("未チェックパス");
	// t = vec.vecInnerproduct(d,k+1)/ 2;
	// for(int i = dim-1; i > k; i-- ) {
	// NyARException.trap("未チェックパス");
	// p = vec.v[i];//p = v.get(i);//p = v[i];
	// d.v[i]-=t*p;q=d.v[i];//q = d->v[i] -= t*p；
	// for(int j = i; j < dim; j++ ){
	// NyARException.trap("未チェックパス");
	// a_array[i][j]-=p*(d.v[j] + q*vec.v[j]);//a->m[i*dim+j] -= p*(d->v[j]) +
	// q*v[j];
	// }
	// }
	// }
	//
	// if( dim >= 2) {
	// d.v[dim-2]=a_array[dim-2][dim-2];//d->v[dim-2] =
	// a->m[(dim-2)*dim+(dim-2)];
	// e.v[dim-2+i_e_start]=a_array[dim-2][dim-1];//e->v[dim-2] =
	// a->m[(dim-2)*dim+(dim-1)];
	// }
	//
	// if( dim >= 1 ){
	// d.v[dim-1]=a_array[dim-1][dim-1];//d->v[dim-1] =
	// a->m[(dim-1)*dim+(dim-1)];
	// }
	//
	// for(int k = dim-1; k >= 0; k--) {
	// vec=a.getRowVec(k);//v = a.getPointer(k*dim);//v = &(a->m[k*dim]);
	// if( k < dim-2 ) {
	// for(int i = k+1; i < dim; i++ ){
	// //wv1.clm = wv2.clm = dim-k-1;
	// //wv1.v = &(v[k+1]);
	// //wv2.v = &(a->m[i*dim+k+1]);
	// vec2=a.getRowVec(i);
	//
	// t = vec.vecInnerproduct(vec2,k+1);
	// for(int j = k+1; j < dim; j++ ){
	// NyARException.trap("未チェックパス");
	// a_array[i][j]-=t*vec.v[j];//a.subValue(i*dim+j,t*v.get(j));//a->m[i*dim+j]
	// -= t * v[j];
	// }
	// }
	// }
	// for(int i = 0; i < dim; i++ ){
	// vec.v[i]=0.0;//v.set(i,0.0);//v[i] = 0.0;
	// }
	// vec.v[k]=1;//v.set(k,1);//v[k] = 1;
	// }
	// }
	/**
	 * 現在ラップしている配列を取り外して、新しい配列をラップします。
	 * 
	 * @param i_v
	 * @param i_clm
	 */
	public void setNewArray(double[] i_array, int i_clm)
	{
		this.v = i_array;
		this.clm = i_clm;
	}
}