/**
* 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);
}
public void saveARParam(StreamWriter i_stream)
{
NyARException.trap("未チェックの関数");
/* byte[] buf = new byte[SIZE_OF_PARAM_SET];
* // バッファをラップ
* ByteBuffer bb = ByteBuffer.wrap(buf);
* bb.order(ByteOrder.BIG_ENDIAN);
*
* // 書き込み
* bb.putInt(this._screen_size.w);
* bb.putInt(this._screen_size.h);
* double[] tmp = new double[12];
* //Projectionを読み出し
* this._projection_matrix.getValue(tmp);
* //double値を12個書き込む
* for (int i = 0; i < 12; i++)
* {
* tmp[i] = bb.getDouble();
* }
* //Factorを読み出し
* this._dist.getValue(tmp);
* //double値を4個書き込む
* for (int i = 0; i < 4; i++)
* {
* tmp[i] = bb.getDouble();
* }
* i_stream.write(buf);
* return;
*/
}
/**
* arMatrixInv関数の代替品です。 destにsourceの逆行列を返します。
*
* @param dest
* @param source
* @throws NyARException
*/
public static void matrixInv(NyARMat dest, NyARMat source)
{
NyARException.trap("未チェックのパス");
dest.matrixDup(source);
NyARException.trap("未チェックのパス");
dest.matrixSelfInv();
}
public static NyARMat matrixAllocMul(NyARMat a, NyARMat b)
{
NyARException.trap("未チェックのパス");
NyARMat dest = new NyARMat(a.row, b.clm);
NyARException.trap("未チェックのパス");
dest.matrixMul(a, b);
return(dest);
}
/* double arMatrixDet(ARMat *m); */
public static double arMatrixDet(NyARMat m)
{
NyARException.trap("動作未チェック/配列化未チェック");
if (m.row != m.clm)
{
return(0.0);
}
return(Det_mdet(m.getArray(), m.row, m.clm));// return mdet(m->m, m->row,m->row);
}
/**
* dim x dim の単位行列を作る。
*
* @param dim
* @return
* @throws NyARException
*/
public static NyARMat matrixAllocUnit(int dim)
{
NyARException.trap("未チェックのパス");
NyARMat result = new NyARMat(dim, dim);
NyARException.trap("未チェックのパス");
NyARMat.matrixUnit(result);
return(result);
}
public NyARMat matrixAllocInv()
{
NyARException.trap("未チェックのパス");
NyARMat result = matrixAllocDup();
NyARException.trap("未チェックのパス");
result.matrixSelfInv();
return(result);
}
/* static double mdet(double *ap, int dimen, int rowa) */
private static double Det_mdet(double[][] ap, int dimen, int rowa)
{
NyARException.trap("動作未チェック/配列化未チェック");
double det = 1.0;
double work;
int is_ = 0;
int mmax;
for (int k = 0; k < dimen - 1; k++)
{
mmax = k;
for (int i = k + 1; i < dimen; i++)
{
// if (Math.abs(arMatrixDet_MATRIX_get(ap, i, k, rowa)) >
// Math.abs(arMatrixDet_MATRIX_get(ap, mmax, k, rowa))){
if (Math.Abs(ap[i][k]) > Math.Abs(ap[mmax][k]))
{
mmax = i;
}
}
if (mmax != k)
{
for (int j = k; j < dimen; j++)
{
work = ap[k][j]; // work = MATRIX(ap, k, j, rowa);
ap[k][j] = ap[mmax][j]; // MATRIX(ap, k, j, rowa) =MATRIX(ap, mmax, j, rowa);
ap[mmax][j] = work; // MATRIX(ap, mmax, j, rowa) = work;
}
is_++;
}
for (int i = k + 1; i < dimen; i++)
{
work = ap[i][k] / ap[k][k]; // work = arMatrixDet_MATRIX_get(ap,i, k, rowa) /arMatrixDet_MATRIX_get(ap, k, k,rowa);
for (int j = k + 1; j < dimen; j++)
{
// MATRIX(ap, i, j, rowa) -= work * MATRIX(ap, k, j, rowa);
ap[i][j] -= work * ap[k][j];
}
}
}
for (int i = 0; i < dimen; i++)
{
det = ap[i][i]; // det *= MATRIX(ap, i, i, rowa);
}
for (int i = 0; i < is_; i++)
{
det *= -1.0;
}
return(det);
}
/**
* sourceの転置行列をdestに得る。arMatrixTrans()の代替品
*
* @param dest
* @param source
* @return
*/
public static void matrixTrans(NyARMat dest, NyARMat source)
{
if (dest.row != source.clm || dest.clm != source.row)
{
throw new NyARException();
}
NyARException.trap("未チェックのパス");
// For順変更禁止
for (int r = 0; r < dest.row; r++)
{
for (int c = 0; c < dest.clm; c++)
{
dest.m[r][c] = source.m[c][r];
}
}
}
/**
* arVecDispの代替品
*
* @param value
* @return
*/
public int arVecDisp()
{
NyARException.trap("未チェックのパス");
Debug.WriteLine(" === vector (" + clm + ") ===\n");// printf(" ===
// vector (%d)
// ===\n",
// v->clm);
Debug.WriteLine(" |"); // printf(" |");
for (int c = 0; c < clm; c++)
{ // for( c = 0; c < v->clm; c++ ){
Debug.WriteLine(" " + v[c]); // printf( " %10g", v->v[c] );
}
Debug.WriteLine(" |"); // printf(" |\n");
Debug.WriteLine(" ==================="); // printf("
// ===================\n");
return(0);
}
/**
* int x_by_xt( ARMat *input, ARMat *output )の代替関数
*
* @param input
* @param output
* @throws NyARException
*/
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();
}
}
}
/* int arMatrixPCA2( ARMat *input, ARMat *evec, ARVec *ev ); */
public static void arMatrixPCA2(NyARMat input, NyARMat evec, NyARVec ev)
{
NyARException.trap("未チェックのパス");
NyARMat work;
// double srow; // unreferenced
double sum;
int row, clm;
int check;
row = input.row; // row = input->row;
clm = input.clm; // clm = input->clm;
check = (row < clm) ? row : clm;
if (row < 2 || clm < 2)
{
throw new NyARException();
}
if (evec.getClm() != input.clm || evec.row != check)
{// if( evec->clm!= input->clm|| evec->row!= check ){
throw new NyARException();
}
if (ev.getClm() != check)
{// if( ev->clm != check ){
throw new NyARException();
}
NyARException.trap("未チェックのパス");
work = input.matrixAllocDup();
NyARException.trap("未チェックパス");
work.PCA_PCA(evec, ev);// rval = PCA( work, evec, ev );
sum = 0.0;
double[] ev_array = ev.getArray();
for (int i = 0; i < ev.getClm(); i++)
{// for( i = 0; i < ev->clm; i++
// ){
NyARException.trap("未チェックパス");
sum += ev_array[i];// sum += ev->v[i];
}
for (int i = 0; i < ev.getClm(); i++)
{ // for(int i = 0; i < ev->clm;i++ ){
NyARException.trap("未チェックパス");
ev_array[i] /= sum; // ev->v[i] /= sum;
}
return;
}
/**
* 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;
}
}
}
}
/**
* arMatrixDispの代替品
*
* @param m
* @return
*/
public int matrixDisp()
{
NyARException.trap("未チェックのパス");
System.Console.WriteLine(" === matrix (" + row + "," + clm + ") ===");// printf("
// ===
// matrix
// (%d,%d)
// ===\n",
// m->row,
// m->clm);
for (int r = 0; r < row; r++)
{ // for(int r = 0; r < m->row; r++) {
System.Console.Write(" |"); // printf(" |");
for (int c = 0; c < clm; c++)
{ // for(int c = 0; c < m->clm; c++) {
System.Console.Write(" " + m[r][c]); // printf(" %10g", ARELEM0(m, r,
// c));
}
System.Console.WriteLine(" |"); // printf(" |\n");
}
System.Console.WriteLine(" ======================"); // printf("
// ======================\n");
return(0);
}
/**
* この関数は機能しません。
* @param i_stream
* 未定義
* @throws Exception
*/
public void saveARParam(StreamWriter i_stream)
{
NyARException.trap("未チェックの関数");
}
/**
* static int PCA( ARMat *input, ARMat *output, ARVec *ev )
*
* @param output
* @param o_ev
* @throws NyARException
*/
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();
}
NyARMat u;// u =new NyARMat( min, min );
if (this.wk_PCA_PCA_u == null)
{
u = new NyARMat(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;
}
}
}
}
/**
* static int EV_create( ARMat *input, ARMat *u, ARMat *output, ARVec *ev)の代替関数
*
* @param input
* @param u
* @param output
* @param ev
* @throws NyARException
*/
private static void PCA_EV_create(NyARMat i_input, NyARMat u, NyARMat output, NyARVec ev)
{
NyARException.trap("未チェックのパス");
int row, clm;
row = i_input.row; // row = input->row;
clm = i_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_ = i_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();
}
}
}
/**
* static int QRM( ARMat *a, ARVec *dv )の代替関数
*
* @param a
* @param dv
* @throws NyARException
*/
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);
}
}
public void setPixel(int i_x, int i_y, int i_r, int i_g, int i_b)
{
NyARException.notImplement();
}
public void doCutFilter(INyARRaster i_input, int l, int t, int i_st, NyARGrayscaleRaster o_output)
{
NyARException.notImplement();
}
public void setPixels(int[] i_x, int[] i_y, int i_num, int[] i_intrgb)
{
NyARException.notImplement();
}
/**
* arVecTridiagonalize関数の代替品 a,d,e間で演算をしてる。何をどうしているかはさっぱりさっぱり
*
* @param a
* @param d
* @param e
* @param i_e_start
* 演算開始列(よくわからないけどarVecTridiagonalizeの呼び出し元でなんかしてる)
* @return
* @throws NyARException
*/
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;
}
public void wrapBuffer(object i_ref_buf)
{
NyARException.notImplement();
}
public override void wrapBuffer(Object i_ref_buf)
{
NyARException.notImplement();
}
