/** * arVecHousehold関数の同等品です。 * 詳細は不明です。 * @param i_start * 演算開始列(よくわからないけどarVecTridiagonalizeの呼び出し元でなんかしてる) * @return * 不明。 * @ */ public double vecHousehold(int i_start) { NyARRuntimeException.trap("この関数は動作確認できていません。"); double s, t; s = Math.Sqrt(this.vecInnerproduct(this, i_start)); // double[] x_array=x.getArray(); if (s != 0.0) { NyARRuntimeException.trap("未チェックのパス"); if (this.v[i_start] < 0) { s = -s; } NyARRuntimeException.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++) { NyARRuntimeException.trap("未チェックのパス"); this.v[i] *= t;// x->v[i] *= t; } } return(-s); }
/** * ARToolKitのx_by_xtと同等な関数です。 * 詳細は不明です。 * この関数は未チェックの為、使用すると例外が発生します。 * @param input * 不明 * @param output * 不明 * @ */ private static void PCA_x_by_xt(NyARMat input, NyARMat output) { NyARRuntimeException.trap("動作未チェック/配列化未チェック"); int row, clm; // double[][] out; double[] in1, in2; NyARRuntimeException.trap("未チェックのパス"); row = input.row; clm = input.clm; NyARRuntimeException.trap("未チェックのパス"); if (output.row != row || output.clm != row) { throw new NyARRuntimeException(); } // out = output.getArray(); for (int i = 0; i < row; i++) { for (int j = 0; j < row; j++) { if (j < i) { NyARRuntimeException.trap("未チェックのパス"); output._m[i][j] = output._m[j][i];// *out = // output->m[j*row+i]; } else { NyARRuntimeException.trap("未チェックのパス"); in1 = input._m[i]; // input.getRowArray(i);//in1 = &(input->m[clm*i]); in2 = input._m[j]; // input.getRowArray(j);//in2 = &(input->m[clm*j]); output._m[i][j] = 0; // *out = 0.0; for (int k = 0; k < clm; k++) { output._m[i][j] += (in1[k] * in2[k]);// *out += *(in1++) // * *(in2++); } } // out.incPtr(); } } }
/** * arVecInnerproduct関数の同等品です。 * この関数は動作チェックをしておらず、機能しません。 * 詳細は不明です。 * @param y * 不明。 * @param i_start * 演算開始列(よくわからないけどarVecTridiagonalizeの呼び出し元でなんかしてる) * @return * 不明。 * @ */ public double vecInnerproduct(NyARVec y, int i_start) { NyARRuntimeException.trap("この関数は動作確認できていません。"); double result = 0.0; // double[] x_array=x.v;.getArray(); // double[] y_array=y.getArray(); if (this.clm != y.clm) { throw new NyARRuntimeException();// exit(); } for (int i = i_start; i < this.clm; i++) { NyARRuntimeException.trap("未チェックのパス"); result += this.v[i] * y.v[i];// result += x->v[i] * y->v[i]; } return(result); }
/** * ARToolKitの、arMatrixUnit関数と同等な関数です。unitを単位行列に初期化します。 * この関数は未チェックの為、実行すると例外が発生します。 * @param unit * 操作するオブジェクト。 */ public static void matrixUnit(NyARMat unit) { if (unit.row != unit.clm) { throw new NyARRuntimeException(); } NyARRuntimeException.trap("未チェックのパス"); // For順変更禁止 for (int r = 0; r < unit.getRow(); r++) { for (int c = 0; c < unit.getClm(); c++) { if (r == c) { unit._m[r][c] = 1.0; } else { unit._m[r][c] = 0.0; } } } }
sealed override public void setPixels(int[] i_x, int[] i_y, int i_num, int[] i_intrgb) { NyARRuntimeException.notImplement(); }
/** * ARToolKitの、arVecTridiagonalize関数と同等な関数です。 * 詳細は不明です。 * @param d * 不明 * @param e * 不明 * @param i_e_start * 演算開始列(よくわからないけどarVecTridiagonalizeの呼び出し元でなんかしてる) * @ */ private void vecTridiagonalize(NyARVec d, NyARVec e, int i_e_start) { NyARVec vec = wk_vecTridiagonalize_vec; // double[][] a_array=a.getArray(); double s, t, p, q; int dim; if (this.clm != this.row) {// if(a.getClm()!=a.getRow()){ throw new NyARRuntimeException(); } if (this.clm != d.getClm()) {// if(a.getClm() != d.clm){ throw new NyARRuntimeException(); } if (this.clm != e.getClm()) {// if(a.getClm() != e.clm){ throw new NyARRuntimeException(); } dim = this.getClm(); double[] d_vec, e_vec; d_vec = d.getArray(); e_vec = e.getArray(); double[] a_vec_k; for (int k = 0; k < dim - 2; k++) { a_vec_k = this._m[k]; vec.setNewArray(a_vec_k, clm);// vec=this.getRowVec(k);//double[] // vec_array=vec.getArray(); NyARRuntimeException.trap("未チェックパス"); d_vec[k] = a_vec_k[k];// 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]); NyARRuntimeException.trap("未チェックパス"); e_vec[k + i_e_start] = vec.vecHousehold(k + 1); // e.v[k+i_e_start]=vec.vecHousehold(k+1);//e->v[k]= arVecHousehold(&wv1); if (e_vec[k + i_e_start] == 0.0) { // if(e.v[k+i_e_start]== 0.0){//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++) { NyARRuntimeException.trap("未チェックのパス"); s += this._m[j][i] * a_vec_k[j];// 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++) { NyARRuntimeException.trap("未チェックのパス"); s += this._m[i][j] * a_vec_k[j];// 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]; } NyARRuntimeException.trap("未チェックのパス"); d_vec[i] = s;// 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]); a_vec_k = this._m[k]; vec.setNewArray(a_vec_k, clm);// vec=this.getRowVec(k); // vec_array=vec.getArray(); NyARRuntimeException.trap("未チェックパス"); t = vec.vecInnerproduct(d, k + 1) / 2; for (int i = dim - 1; i > k; i--) { NyARRuntimeException.trap("未チェックパス"); p = a_vec_k[i]; // p = v.get(i);//p = v[i]; d_vec[i] -= t * p; q = d_vec[i]; // d.v[i]-=t*p;q=d.v[i];//q = d->v[i] -= t*p; for (int j = i; j < dim; j++) { NyARRuntimeException.trap("未チェックパス"); this._m[i][j] -= p * (d_vec[j] + q * a_vec_k[j]);// a.m[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_vec[dim - 2] = this._m[dim - 2][dim - 2]; // d.v[dim-2]=a.m[dim-2][dim-2];//d->v[dim-2]=a->m[(dim-2)*dim+(dim-2)]; e_vec[dim - 2 + i_e_start] = this._m[dim - 2][dim - 1]; // e.v[dim-2+i_e_start]=a.m[dim-2][dim-1];//e->v[dim-2] = a->m[(dim-2)*dim+(dim-1)]; } if (dim >= 1) { d_vec[dim - 1] = this._m[dim - 1][dim - 1];// d.v[dim-1]=a_array[dim-1][dim-1];//d->v[dim-1] =a->m[(dim-1)*dim+(dim-1)]; } NyARVec vec2 = this.wk_vecTridiagonalize_vec2; for (int k = dim - 1; k >= 0; k--) { a_vec_k = this._m[k]; vec.setNewArray(a_vec_k, clm);// vec=this.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.setNewArray(this._m[i], clm);// vec2=this.getRowVec(i); t = vec.vecInnerproduct(vec2, k + 1); for (int j = k + 1; j < dim; j++) { NyARRuntimeException.trap("未チェックパス"); this._m[i][j] -= t * a_vec_k[j];// 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++) { a_vec_k[i] = 0.0; // v.set(i,0.0);//v[i] = 0.0; } a_vec_k[k] = 1; // v.set(k,1);//v[k] = 1; } return; }
/** * ARToolKitのQRM関数と同等な関数です。 * 詳細は不明です。 * @param dv * 不明 * @ */ private void PCA_QRM(NyARVec dv) { double w, t, s, x, y, c; int dim, iter; double[] dv_array = dv.getArray(); dim = this.row; if (dim != this.clm || dim < 2) { throw new NyARRuntimeException(); } if (dv.getClm() != dim) { throw new NyARRuntimeException(); } NyARVec ev = this.wk_PCA_QRM_ev; ev.realloc(dim); double[] ev_array = ev.getArray(); if (ev == null) { throw new NyARRuntimeException(); } double[][] L_m = this._m; this.vecTridiagonalize(dv, ev, 1); ev_array[0] = 0.0;// ev->v[0] = 0.0; for (int h = dim - 1; h > 0; h--) { int j = h; while (j > 0 && Math.Abs(ev_array[j]) > PCA_EPS * (Math.Abs(dv_array[j - 1]) + Math.Abs(dv_array[j]))) {// while(j>0 && fabs(ev->v[j]) >EPS*(fabs(dv->v[j-1])+fabs(dv->v[j]))) // j--; j--; } if (j == h) { continue; } iter = 0; do { iter++; if (iter > PCA_MAX_ITER) { break; } w = (dv_array[h - 1] - dv_array[h]) / 2; // w = (dv->v[h-1] -dv->v[h]) / 2;//ここ? t = ev_array[h] * ev_array[h]; // t = ev->v[h] * ev->v[h]; s = Math.Sqrt(w * w + t); if (w < 0) { s = -s; } x = dv_array[j] - dv_array[h] + t / (w + s); // x = dv->v[j] -dv->v[h] +t/(w+s); y = ev_array[j + 1]; // y = ev->v[j+1]; for (int k = j; k < h; k++) { if (Math.Abs(x) >= Math.Abs(y)) { if (Math.Abs(x) > PCA_VZERO) { t = -y / x; c = 1 / Math.Sqrt(t * t + 1); s = t * c; } else { c = 1.0; s = 0.0; } } else { t = -x / y; s = 1.0 / Math.Sqrt(t * t + 1); c = t * s; } w = dv_array[k] - dv_array[k + 1]; // w = dv->v[k] -dv->v[k+1]; t = (w * s + 2 * c * ev_array[k + 1]) * s; // t = (w * s +2 * c *ev->v[k+1]) *s; dv_array[k] -= t; // dv->v[k] -= t; dv_array[k + 1] += t; // dv->v[k+1] += t; if (k > j) { NyARRuntimeException.trap("未チェックパス"); { ev_array[k] = c * ev_array[k] - s * y;// ev->v[k]= c *ev->v[k]- s * y; } } ev_array[k + 1] += s * (c * w - 2 * s * ev_array[k + 1]);// ev->v[k+1]+= s * (c* w- 2* s *ev->v[k+1]); for (int i = 0; i < dim; i++) { x = L_m[k][i]; // x = a->m[k*dim+i]; y = L_m[k + 1][i]; // y = a->m[(k+1)*dim+i]; L_m[k][i] = c * x - s * y; // a->m[k*dim+i] = c * x - s* y; L_m[k + 1][i] = s * x + c * y; // a->m[(k+1)*dim+i] = s* x + c * y; } if (k < h - 1) { NyARRuntimeException.trap("未チェックパス"); { x = ev_array[k + 1]; // x = ev->v[k+1]; y = -s * ev_array[k + 2]; // y = -s * ev->v[k+2]; ev_array[k + 2] *= c; // ev->v[k+2] *= c; } } } } while (Math.Abs(ev_array[h]) > PCA_EPS * (Math.Abs(dv_array[h - 1]) + Math.Abs(dv_array[h]))); } for (int k = 0; k < dim - 1; k++) { int h = k; t = dv_array[h];// t = dv->v[h]; for (int i = k + 1; i < dim; i++) { if (dv_array[i] > t) { // if( dv->v[i] > t ) { h = i; t = dv_array[h]; // t = dv->v[h]; } } dv_array[h] = dv_array[k]; // dv->v[h] = dv->v[k]; dv_array[k] = t; // dv->v[k] = t; this.flipRow(h, k); } }
private const double PCA_VZERO = 1e-16; // #define VZERO 1e-16 /** * ARToolKitのEV_create関数と同等な関数です。 * 詳細は不明です。 * @param input * 不明。 * @param u * 不明。 * @param output * 不明。 * @param ev * 不明。 * @ */ private static void PCA_EV_create(NyARMat input, NyARMat u, NyARMat output, NyARVec ev) { NyARRuntimeException.trap("未チェックのパス"); int row, clm; row = input.row; // row = input->row; clm = input.clm; // clm = input->clm; if (row <= 0 || clm <= 0) { throw new NyARRuntimeException(); } if (u.row != row || u.clm != row) {// if( u->row != row || u->clm != // row ){ throw new NyARRuntimeException(); } if (output.row != row || output.clm != clm) {// if( output->row != // row || output->clm != // clm ){ throw new NyARRuntimeException(); } if (ev.getClm() != row) {// if( ev->clm != row ){ throw new NyARRuntimeException(); } double[][] m, in_; double[] m1, ev_array; double sum, work; NyARRuntimeException.trap("未チェックのパス"); m = output._m;// m = output->m; in_ = input._m; int i; ev_array = ev.getArray(); for (i = 0; i < row; i++) { NyARRuntimeException.trap("未チェックのパス"); if (ev_array[i] < PCA_VZERO) {// if( ev->v[i] < VZERO ){ break; } NyARRuntimeException.trap("未チェックのパス"); work = 1 / Math.Sqrt(Math.Abs(ev_array[i]));// work = 1 / // sqrt(fabs(ev->v[i])); for (int j = 0; j < clm; j++) { sum = 0.0; m1 = u._m[i];// m1 = &(u->m[i*row]); // m2=input.getPointer(j);//m2 = &(input->m[j]); for (int k = 0; k < row; k++) { sum += m1[k] + in_[k][j];// sum += *m1 * *m2; // m1.incPtr(); //m1++; // m2.addPtr(clm);//m2 += clm; } m1[j] = sum * work;// *(m++) = sum * work; // {//*(m++) = sum * work; // m.set(sum * work); // m.incPtr();} } } for (; i < row; i++) { NyARRuntimeException.trap("未チェックのパス"); ev_array[i] = 0.0;// ev->v[i] = 0.0; for (int j = 0; j < clm; j++) { m[i][j] = 0.0; // m.set(0.0);//*(m++) = 0.0; // m.incPtr(); } } }
/** * ARToolKitのPCA関数と同等な関数です。 * 詳細は不明です。 * @param output * 不明 * @param o_ev * 不明 * @ */ private void PCA_PCA(NyARMat o_output, NyARVec o_ev) { int l_row, l_clm, min; double[] ev_array = o_ev.getArray(); l_row = this.row; // row = input->row; l_clm = this.clm; // clm = input->clm; min = (l_clm < l_row) ? l_clm : l_row; if (l_row < 2 || l_clm < 2) { throw new NyARRuntimeException(); } if (o_output.clm != this.clm) {// if( output->clm != input->clm ){ throw new NyARRuntimeException(); } if (o_output.row != min) {// if( output->row != min ){ throw new NyARRuntimeException(); } if (o_ev.getClm() != min) {// if( ev->clm != min ){ throw new NyARRuntimeException(); } NyARMatPca u;// u =new NyARMat( min, min ); if (this.wk_PCA_PCA_u == null) { u = new NyARMatPca(min, min); this.wk_PCA_PCA_u = u; } else { u = this.wk_PCA_PCA_u; u.realloc(min, min); } if (l_row < l_clm) { NyARRuntimeException.trap("未チェックのパス"); PCA_x_by_xt(this, u);// if(x_by_xt( input, u ) < 0 ) { } else { PCA_xt_by_x(this, u);// if(xt_by_x( input, u ) < 0 ) { } u.PCA_QRM(o_ev); double[][] m1, m2; if (l_row < l_clm) { NyARRuntimeException.trap("未チェックのパス"); PCA_EV_create(this, u, o_output, o_ev); } else { m1 = u._m; // m1 = u->m; m2 = o_output._m; // m2 = output->m; int i; for (i = 0; i < min; i++) { if (ev_array[i] < PCA_VZERO) {// if( ev->v[i] < VZERO ){ break; } for (int j = 0; j < min; j++) { m2[i][j] = m1[i][j];// *(m2++) = *(m1++); } } for (; i < min; i++) { // for( ; i < min; i++){ // コードを見た限りあってそうだからコメントアウト(2008/03/26)NyARException.trap("未チェックのパス"); ev_array[i] = 0.0; // ev->v[i] = 0.0; for (int j = 0; j < min; j++) { m2[i][j] = 0.0;// *(m2++) = 0.0; } } } }
sealed override public void setPixel(int i_x, int i_y, int i_r, int i_g, int i_b) { NyARRuntimeException.notImplement(); }
public void wrapBuffer(Object i_ref_buf) { NyARRuntimeException.notImplement(); }
/** * この関数は機能しません。 * @param i_stream * 未定義 * @throws Exception */ public void saveARParam(StreamWriter i_stream) { NyARRuntimeException.trap("未チェックの関数"); }
/** * このクラスでは、関数は機能しません。 */ public override void wrapBuffer(object i_ref_buf) { NyARRuntimeException.notImplement(); }