/**
* arVecHousehold関数の同等品です。
* 詳細は不明です。
* @param i_start
* 演算開始列(よくわからないけどarVecTridiagonalizeの呼び出し元でなんかしてる)
* @return
* 不明。
* @
*/
public double vecHousehold(int i_start)
{
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);
}
/**
* ARToolKitのx_by_xtと同等な関数です。
* 詳細は不明です。
* この関数は未チェックの為、使用すると例外が発生します。
* @param input
* 不明
* @param output
* 不明
* @
*/
private static void PCA_x_by_xt(NyARMat input, NyARMat output)
{
NyARException.Trap("動作未チェック/配列化未チェック");
int row, clm;
// double[][] out;
double[] in1, in2;
NyARException.Trap("未チェックのパス");
row = input.row;
clm = input.clm;
NyARException.Trap("未チェックのパス");
if (output.row != row || output.clm != row)
{
throw new NyARException();
}
// out = output.getArray();
for (int i = 0; i < row; i++)
{
for (int j = 0; j < row; j++)
{
if (j < i)
{
NyARException.Trap("未チェックのパス");
output._m[i][j] = output._m[j][i];// *out =
// output->m[j*row+i];
}
else
{
NyARException.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)
{
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);
}
/**
* ARToolKitの、arMatrixUnit関数と同等な関数です。unitを単位行列に初期化します。
* この関数は未チェックの為、実行すると例外が発生します。
* @param unit
* 操作するオブジェクト。
*/
public static void matrixUnit(NyARMat unit)
{
if (unit.row != unit.clm)
{
throw new NyARException();
}
NyARException.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;
}
}
}
}
/**
* 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 NyARException();
}
if (this.clm != d.getClm())
{// if(a.getClm() != d.clm){
throw new NyARException();
}
if (this.clm != e.getClm())
{// if(a.getClm() != e.clm){
throw new NyARException();
}
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();
NyARException.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]);
NyARException.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++)
{
NyARException.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++)
{
NyARException.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];
}
NyARException.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();
NyARException.Trap("未チェックパス");
t = vec.vecInnerproduct(d, k + 1) / 2;
for (int i = dim - 1; i > k; i--)
{
NyARException.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++)
{
NyARException.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++)
{
NyARException.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 NyARException();
}
if (dv.getClm() != dim)
{
throw new NyARException();
}
NyARVec ev = this.wk_PCA_QRM_ev;
ev.realloc(dim);
double[] ev_array = ev.getArray();
if (ev == null)
{
throw new NyARException();
}
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)
{
NyARException.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)
{
NyARException.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)
{
NyARException.Trap("未チェックのパス");
int row, clm;
row = input.row; // row = input->row;
clm = input.clm; // clm = input->clm;
if (row <= 0 || clm <= 0)
{
throw new NyARException();
}
if (u.row != row || u.clm != row)
{// if( u->row != row || u->clm !=
// row ){
throw new NyARException();
}
if (output.row != row || output.clm != clm)
{// if( output->row !=
// row || output->clm !=
// clm ){
throw new NyARException();
}
if (ev.getClm() != row)
{// if( ev->clm != row ){
throw new NyARException();
}
double[][] m, in_;
double[] m1, ev_array;
double sum, work;
NyARException.Trap("未チェックのパス");
m = output._m;// m = output->m;
in_ = input._m;
int i;
ev_array = ev.getArray();
for (i = 0; i < row; i++)
{
NyARException.Trap("未チェックのパス");
if (ev_array[i] < PCA_VZERO)
{// if( ev->v[i] < VZERO ){
break;
}
NyARException.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++)
{
NyARException.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 NyARException();
}
if (o_output.clm != this.clm)
{// if( output->clm != input->clm ){
throw new NyARException();
}
if (o_output.row != min)
{// if( output->row != min ){
throw new NyARException();
}
if (o_ev.getClm() != min)
{// if( ev->clm != min ){
throw new NyARException();
}
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)
{
NyARException.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)
{
NyARException.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;
}
}
}
}
/**
* この関数は機能しません。
* @param i_stream
* 未定義
* @throws Exception
*/
public void saveARParam(StreamWriter i_stream)
{
NyARException.Trap("未チェックの関数");
}