public Ray GenerateRay(LocalGeo geo, out RTColor color)
{
color = Color;
RTVector ray = Source - geo.Point;
return(new Ray(geo.Point, ray.Normalize(), 1e-3f, ray.Length, false));
}
private Matrix4x4 ComputeMatrix(RTVector axisIn, float radians)
{
Matrix4x4 matrix;
if (axisIn.X == 1 && axisIn.Y == 0 && axisIn.Z == 0)
{
matrix = Matrix4x4.CreateRotationX(radians);
}
else if (axisIn.X == 0 && axisIn.Y == 1 && axisIn.Z == 0)
{
matrix = Matrix4x4.CreateRotationY(radians);
}
else if (axisIn.X == 0 && axisIn.Y == 0 && axisIn.Z == 1)
{
matrix = Matrix4x4.CreateRotationZ(radians);
}
else
{
RTVector axis = axisIn.Normalize();
Matrix4x4 part1 = Matrix4x4.Multiply(Matrix4x4.Identity, (float)Math.Cos(radians));
Matrix4x4 part2 = Matrix4x4.Multiply(new Matrix4x4((float)Math.Pow(axis.X, 2), axis.X * axis.Y, axis.X * axis.Z, 0,
axis.X * axis.Y, (float)Math.Pow(axis.Y, 2), axis.Y * axis.Z, 0,
axis.X * axis.Z, axis.Y * axis.Z, (float)Math.Pow(axis.Z, 2), 0,
0, 0, 0, 0),
1.0f - (float)Math.Cos(radians));
Matrix4x4 part3 = Matrix4x4.Multiply(new Matrix4x4(0, -axis.Z, axis.Y, 0,
axis.Z, 0, -axis.X, 0,
-axis.Y, axis.X, 0, 0,
0, 0, 0, 0),
(float)Math.Sin(radians));
matrix = part1 + Matrix4x4.Transpose(part2) + Matrix4x4.Transpose(part3);
matrix.M44 = 1;
}
return(matrix);
}