public static float CalcError(SMat3 origA, Vector3 x, Vector3 b) { Mat3 A = new Mat3(); A.SetSymmetric(origA); Vector3 vtmp = A.Vmul(x); vtmp = b - vtmp; return vtmp.X * vtmp.X + vtmp.Y * vtmp.Y + vtmp.Z * vtmp.Z; }
public static float CalcError(SMat3 origA, Vector3 x, Vector3 b) { Mat3 A = new Mat3(); A.SetSymmetric(origA); Vector3 vtmp = A.Vmul(x); vtmp = b - vtmp; return(vtmp.X * vtmp.X + vtmp.Y * vtmp.Y + vtmp.Z * vtmp.Z); }