magnum/src/Math/Algorithms/Test/GaussJordanTest.cpp

/*
    Copyright © 2010, 2011, 2012 Vladimír Vondruš <mosra@centrum.cz>

    This file is part of Magnum.

    Magnum is free software: you can redistribute it and/or modify
    it under the terms of the GNU Lesser General Public License version 3
    only, as published by the Free Software Foundation.

    Magnum is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
    GNU Lesser General Public License version 3 for more details.
*/

#include <TestSuite/Tester.h>

#include "Math/Matrix.h"
#include "Math/Algorithms/GaussJordan.h"

namespace Magnum { namespace Math { namespace Algorithms { namespace Test {

class GaussJordanTest: public Corrade::TestSuite::Tester {
    public:
        explicit GaussJordanTest();

        void singular();
        void invert();
};

typedef Matrix<4, float> Matrix4;

GaussJordanTest::GaussJordanTest() {
    addTests(&GaussJordanTest::singular,
             &GaussJordanTest::invert);
}

void GaussJordanTest::singular() {
    Matrix4 a(1.0f, 2.0f, 3.0f, 4.0f,
              2.0f, 3.0f, -7.0f, 11.0f,
              2.0f, 4.0f, 6.0f, 8.0f,
              1.0f, 2.0f, 7.0f, 40.0f);
    RectangularMatrix<4, 1, float> t;

    CORRADE_VERIFY(!GaussJordan::inPlaceTransposed(a, t));
}

void GaussJordanTest::invert() {
    Matrix4 a(3.0f, 5.0f, 8.0f, 4.0f,
              4.0f, 4.0f, 7.0f, 3.0f,
              7.0f, -1.0f, 8.0f, 0.0f,
              9.0f, 4.0f, 5.0f, 9.0f);

    Matrix4 expectedInverse(-60/103.0f, 71/103.0f,  -4/103.0f,   3/103.0f,
                            -66/103.0f, 109/103.0f, -25/103.0f, -7/103.0f,
                            177/412.0f, -97/206.0f,  53/412.0f, -7/206.0f,
                            259/412.0f, -185/206.0f, 31/412.0f,  27/206.0f);

    Matrix4 a2(a);
    Matrix4 inverse(Matrix4::Identity);
    CORRADE_VERIFY(GaussJordan::inPlace(a2, inverse));

    CORRADE_COMPARE(inverse, expectedInverse);
    CORRADE_COMPARE(a*inverse, Matrix4());
}

}}}}

CORRADE_TEST_MAIN(Magnum::Math::Algorithms::Test::GaussJordanTest)