private void simpleButton1_Click(object sender, EventArgs e)
{
DataTable posDt = this.ucPosPair1.GetPosPair();
if (posDt == null || posDt.Rows.Count < 3)
{
MessageBox.Show("请输入至少三组数据");
return;
}
CoordTrans7Param calparam = new CoordTrans7Param();
//double[,] souPos = new double[9, 1] { { 111.11},{ 39.12}, {12 }, { 118.345}, {40.123},{ 4 }, { 123.111}, {24.334},{ 2 } };
//double[,] tarPos = new double[9, 1] { { 111.22}, {39.16}, {12 }, { 118.123}, {40.345},{ 6 }, { 123.104}, {24.304},{ 8 } };
double[,] souPos = new double[posDt.Rows.Count * 3, 1];
double[,] tarPos = new double[posDt.Rows.Count * 3, 1];
double sx, sy, sz, tx, ty, tz;
for (int i = 0; i < posDt.Rows.Count; i++)
{
if (!double.TryParse(posDt.Rows[i]["SOU_X"].ToString(), out sx))
{
sx = 0;
}
if (!double.TryParse(posDt.Rows[i]["SOU_Y"].ToString(), out sy))
{
sy = 0;
}
if (!double.TryParse(posDt.Rows[i]["SOU_Z"].ToString(), out sz))
{
sz = 0;
}
if (!double.TryParse(posDt.Rows[i]["TAR_X"].ToString(), out tx))
{
tx = 0;
}
if (!double.TryParse(posDt.Rows[i]["TAR_Y"].ToString(), out ty))
{
ty = 0;
}
if (!double.TryParse(posDt.Rows[i]["TAR_Z"].ToString(), out tz))
{
tz = 0;
}
souPos[i * 3, 0] = sx;
souPos[i * 3 + 1, 0] = sy;
souPos[i * 3 + 2, 0] = sz;
tarPos[i * 3, 0] = tx;
tarPos[i * 3 + 1, 0] = ty;
tarPos[i * 3 + 2, 0] = tz;
}
double result = calparam.CalculateTrans7Param(souPos, tarPos);
this._trancParamClass = new CoordTrancParamClass();
this._trancParamClass.DX = calparam.dx;
this._trancParamClass.DY = calparam.dy;
this._trancParamClass.DZ = calparam.dz;
this._trancParamClass.DS = calparam.k;
this._trancParamClass.RX = calparam.rx;
this._trancParamClass.RY = calparam.ry;
this._trancParamClass.RZ = calparam.rz;
this._trancParamClass.Accuracy = result;
this.memoEdit1.Text = string.Format("dx:{0} dy:{1} dz:{2}\r\nrx:{3} ry:{4} rz:{5}\r\nds:{6}"
, calparam.dx, calparam.dy, calparam.dz, calparam.rx, calparam.ry, calparam.rz, calparam.k);
MessageBox.Show("参数计算完成");
}
