148 lines
3.4 KiB
C++
148 lines
3.4 KiB
C++
#include "matrix.hpp"
|
|
|
|
#include "debug.hpp"
|
|
#include "tap.hpp"
|
|
#include "vector.hpp"
|
|
|
|
#include <cstdlib>
|
|
|
|
int
|
|
main (void)
|
|
{
|
|
util::TAP::logger tap;
|
|
|
|
{
|
|
// Identity matrix-vector multiplication
|
|
auto v = util::vector4f { 1.f, 2.f, 3.f, 4.f };
|
|
auto r = util::matrix4f::IDENTITY * v;
|
|
tap.expect_eq (r, v, "identity matrix-vector multiplication");
|
|
}
|
|
|
|
{
|
|
// Simple matrix-vector multiplication
|
|
util::matrix4f m { {
|
|
{ 1, 2, 3, 4 },
|
|
{ 5, 6, 7, 8 },
|
|
{ 9, 10, 11, 12 },
|
|
{ 13, 14, 15, 16 }
|
|
} };
|
|
|
|
util::vector<4,float> v { 1.f, 2.f, 3.f, 4.f };
|
|
|
|
auto r = m * v;
|
|
|
|
tap.expect (
|
|
almost_equal (r.x, 30) &&
|
|
almost_equal (r.y, 70) &&
|
|
almost_equal (r.z, 110) &&
|
|
almost_equal (r.w, 150),
|
|
"simple matrix-vector multiplication"
|
|
);
|
|
}
|
|
|
|
{
|
|
// Simple matrix-matrix multiplication
|
|
util::matrix4f a { {
|
|
{ 1, 2, 3, 4 },
|
|
{ 5, 6, 7, 8 },
|
|
{ 9, 10, 11, 12 },
|
|
{ 13, 14, 15, 16 },
|
|
} };
|
|
|
|
util::matrix4f b { {
|
|
{ 17, 18, 19, 20 },
|
|
{ 21, 22, 23, 24 },
|
|
{ -1, -2, -3, -4 },
|
|
{ -5, -6, -7, -8 }
|
|
} };
|
|
|
|
util::matrix4f ab { {
|
|
{ 9, 8, 7, 6 },
|
|
{ 41, 40, 39, 38 },
|
|
{ 73, 72, 71, 70 },
|
|
{ 105, 104, 103, 102 },
|
|
} };
|
|
|
|
ab *= 4.f;
|
|
|
|
auto res = a * b;
|
|
|
|
tap.expect_eq (ab, res, "simple matrix-matrix multiplication");
|
|
}
|
|
|
|
|
|
{
|
|
bool success = true;
|
|
|
|
// Ensure identity inverts to identity
|
|
auto m = util::matrix4f::IDENTITY.inverse ();
|
|
for (size_t r = 0; r < m.rows; ++r)
|
|
for (size_t c = 0; c < m.cols; ++c)
|
|
if (r == c)
|
|
success = success && almost_equal (m.values[r][c], 1);
|
|
else
|
|
success = success && almost_equal (m.values[r][c], 0);
|
|
|
|
tap.expect (success, "identity inversion");
|
|
}
|
|
|
|
// Simple 2x2 inversion test
|
|
{
|
|
util::matrix2f m { {
|
|
{ 1, 2 },
|
|
{ 3, 4 }
|
|
} };
|
|
|
|
tap.expect_eq (-2, m.determinant (), "2x2 determinant");
|
|
|
|
util::matrix2f r { {
|
|
{ -4, 2 },
|
|
{ 3, -1 }
|
|
} };
|
|
|
|
tap.expect_eq (r / 2.f, m.inverse (), "2x2 inversion");
|
|
}
|
|
|
|
// Simple 3x3 inversion test
|
|
{
|
|
util::matrix3f m { {
|
|
{ 3, 1, 2 },
|
|
{ 2, 3, 1 },
|
|
{ 4, 0, 2 }
|
|
} };
|
|
|
|
tap.expect_eq (-6, m.determinant (), "3x3 determinant");
|
|
|
|
util::matrix3f r { {
|
|
{ -6, 2, 5 },
|
|
{ 0, 2, -1 },
|
|
{ 12, -4, -7 }
|
|
} };
|
|
|
|
tap.expect_eq (m.inverse (), r / 6.f, "3x3 inversion");
|
|
}
|
|
|
|
// Simple 4x4 inversion test
|
|
{
|
|
util::matrix4f m { {
|
|
{ 4, 1, 2, 3 },
|
|
{ 2, 3, 4, 1 },
|
|
{ 3, 4, 1, 2 },
|
|
{ 1, 2, 3, 4 }
|
|
} };
|
|
|
|
tap.expect_eq (-160.f, m.determinant (), "4x4 determinant");
|
|
|
|
util::matrix4f r { {
|
|
{ 11, 1, 1, -9 },
|
|
{ -9, 1, 11, 1 },
|
|
{ 1, 11, -9, 1 },
|
|
{ 1, -9, 1, 11 }
|
|
} };
|
|
|
|
tap.expect_eq (m.inverse (), r / 40.f, "4x4 inversion");
|
|
}
|
|
|
|
return tap.status ();
|
|
}
|