45 lines
882 B
C++
45 lines
882 B
C++
|
|
#include "Matrix.h"
|
|
|
|
Matrix Matrix::identity()
|
|
{
|
|
Matrix res;
|
|
for (int i = 0; i < 4; i++)
|
|
{
|
|
for (int j = 0; j < 4; j++)
|
|
{
|
|
res[i][j] = i == j ? 1.0 : 0.0;
|
|
}
|
|
}
|
|
return res;
|
|
}
|
|
|
|
Matrix operator*(const Matrix & m1, const Matrix & m2)
|
|
{
|
|
Matrix res;
|
|
for (int i = 0; i < 4; i++)
|
|
{
|
|
for (int j = 0; j < 4; j++)
|
|
{
|
|
res[i][j] = m1[i][0] * m2[0][j]
|
|
+ m1[i][1] * m2[1][j]
|
|
+ m1[i][2] * m2[2][j]
|
|
+ m1[i][3] * m2[3][j];
|
|
}
|
|
}
|
|
return res;
|
|
}
|
|
|
|
Vector operator*(const Matrix & m, const Vector & v)
|
|
{
|
|
Vector res;
|
|
for (int i = 0; i < 4; i++)
|
|
{
|
|
res[i] = m[i][0] * v[0]
|
|
+ m[i][1] * v[1]
|
|
+ m[i][2] * v[2]
|
|
+ m[i][3]; /* v[3] is implicitly 1.0 */
|
|
}
|
|
return res;
|
|
}
|