private double[,] GetV(double[,] X, double[,] Y, CoordTrans7Param dpp)
{
int rowNum = X.GetLength(0);
double[,] B, F, A, B2, B3, F2, V;
double[,] AT = MatrixTool.Init(6, 3);
A = GetA();
MatrixTool.AT(A, ref AT);
MatrixTool.MutliConst(ref AT, 1 / (1 + (1 + k) * (1 + k)));
F = GetF(X, Y);
B = GetB(X);
B2 = MatrixTool.Init(3, 7);
B3 = MatrixTool.Init(3, 1);
F2 = MatrixTool.Init(rowNum, 1);
for (int i = 0; i < rowNum / 3; i++)
{
MatrixTool.CopySub(B, i * 3, 0, 3, 7, ref B2, 0, 0);
MatrixTool.Multi(B2, dpp.values, ref B3);
MatrixTool.CopySub(B3, 0, 0, 3, 1, ref F2, i * 3, 0);
}
MatrixTool.Sub(F, F2, ref F2);
V = specialMulti(AT, F2);
return(V);
}
private double[,] GetA()
{
double[,] M = GetM();
double[,] I2 = MatrixTool.Ident(3);
double[,] A = MatrixTool.Init(3, 6);
MatrixTool.MutliConst(ref I2, -1);
MatrixTool.MutliConst(ref M, (1 + k));
MatrixTool.CopySub(M, 0, 0, 3, 3, ref A, 0, 0);
MatrixTool.CopySub(I2, 0, 0, 3, 3, ref A, 0, 3);
return(A);
}