public static Vector GetCorrespondingVector(Vector vector, Matrix matrix, AxisConstraint axisConstraint)
{
if (matrix.HasInverse)
{
if (axisConstraint != null)
{
vector = axisConstraint.GetConstrainedVector(vector);
}
Matrix matrix1 = matrix;
matrix1.Invert();
return(vector * matrix1);
}
Vector vector1 = matrix.Transform(new Vector(1.0, 0.0));
double length1 = vector1.Length;
Vector vector2 = matrix.Transform(new Vector(0.0, 1.0));
double length2 = vector2.Length;
if (FloatingPointArithmetic.IsVerySmall(length1) && FloatingPointArithmetic.IsVerySmall(length2))
{
return(new Vector(0.0, 0.0));
}
Vector vector3 = length1 > length2 ? vector1 : vector2;
vector3.Normalize();
double num1 = vector * vector3;
double num2 = length1 * length1 + length2 * length2;
return(new Vector(length1 * num1 / num2, length2 * num1 / num2));
}
