test_orthonormal.cpp

// Description: Testing for orthonormal.h
// DocumentationOf: orthonormal.h

#include "test/test_init.h"

#include "pastel/math/matrix/orthonormal.h"
#include "pastel/math/matrix/matrix_norm.h"
#include "pastel/math/matrix/random_matrix.h"

TEST_CASE("orthonormal (orthonormal)")
{
    Matrix<real> m =
        diagonalMatrix(Vector3(1, 2, 3));

    m = orthonormalize(m);
    {
        REQUIRE(frobeniusNorm(m - identityMatrix<real>(3, 3)) < 0.0001);
    }

    m = randomMatrix<real>(3, 3);
    m = orthonormalize(m);
    {
        REQUIRE(frobeniusNorm(transpose(m) * m - 
            identityMatrix<real>(3, 3)) < 0.0001);
    }
}