// public Matrix<double> Scale(Matrix<double> modelMatrix, Vector<double> scalingVector)
// {
// Matrix<double> scalingMatrix = DenseMatrix.OfArray(new double[,]
// {
// {scalingVector[0], 0, 0, 0},
// {0, scalingVector[1], 0, 0},
// {0, 0, scalingVector[2], 0},
// {0, 0, 0, 1}
// });
//
// Matrix<double> scaledmatrix = modelMatrix * scalingMatrix;
// return scaledmatrix;
// }
public Matrix Rotate(Vector rotationVector, double rotationAngle)
{
double rotCos = Cos(rotationAngle), rotSin = Sin(rotationAngle);
double Rx = rotationVector.x, Ry = rotationVector.y, Rz = rotationVector.z;
double RxRy = Rx * Ry, RxRz = Rx * Rz, RyRx = Ry * Rx, RyRz = Ry * Rz, RzRx = Rz * Rx, RzRy = Rz * Ry;
Matrix rotationMatrix = new Matrix(new double[, ]
{
{
rotCos + Pow(Rx, 2) * (1 - rotCos), RxRy * (1 - rotCos) - Rz * rotSin,
RxRz * (1 - rotCos) + Ry * rotSin, 0
},
{
RyRx *(1 - rotCos) + Rz * rotSin, rotCos + Pow(Ry, 2) * (1 - rotCos),
RyRz * (1 - rotCos) - Rx * rotSin, 0
},
{
RzRx *(1 - rotCos) - Ry * rotSin, RzRy * (1 - rotCos) + Rx * rotSin,
rotCos + Pow(Rz, 2) * (1 - rotCos), 0
},
{ 0, 0, 0, 1 }
});
return(rotationMatrix);
}
public Matrix Scale(Vector scalingVector)
{
Matrix scalingMatrix = new Matrix(new double[, ]
{
{ scalingVector.x, 0, 0, 0 },
{ 0, scalingVector.y, 0, 0 },
{ 0, 0, scalingVector.z, 0 },
{ 0, 0, 0, 1 }
});
return(scalingMatrix);
}
// public Matrix<double> Rotate(Matrix<double> modelMatrix, Vector<double> rotationVector, double rotationAngle)
// {
// double rotCos = Cos(rotationAngle), rotSin = Sin(rotationAngle);
// double Rx = rotationVector[0], Ry = rotationVector[1], Rz = rotationVector[2];
// double RxRy = Rx * Ry, RxRz = Rx * Rz, RyRx = Ry * Rx, RyRz = Ry * Rz, RzRx = Rz * Rx, RzRy = Rz * Ry;
//
// Matrix<double> rotationMatrix = DenseMatrix.OfArray(new double[,]
// {
// {rotCos + Pow(Rx, 2) * (1 - rotCos), RxRy * (1 - rotCos) - Rz * rotSin, RxRz * (1 - rotCos) + Ry * rotSin, 0},
// {RyRx * (1 - rotCos) + Rz * rotSin, rotCos + Pow(Ry, 2) * (1 - rotCos), RyRz * (1 - rotCos) - Rx * rotSin, 0},
// {RzRx * (1 - rotCos) - Ry * rotSin, RzRy * (1 - rotCos) + Rx * rotSin, rotCos + Pow(Rz, 2) * (1 - rotCos), 0},
// {0, 0, 0, 1}
// });
//
// Matrix<double> rotatedMatrix = modelMatrix * rotationMatrix;
// return rotationMatrix;
// }
public Matrix Translate(Vector translationVector)
{
Matrix translationMatrix = new Matrix(new double[, ]
{
{ 1, 0, 0, translationVector.x },
{ 0, 1, 0, translationVector.y },
{ 0, 0, 1, translationVector.z },
{ 0, 0, 0, 1 }
});
return(translationMatrix);
}
public Matrix Transform(Vector scaleVector, Vector rotationVector, double rotationAngle,
Vector translationVector)
{
return(Translate(translationVector) * Rotate(rotationVector, rotationAngle) * Scale(scaleVector));
}
