px4_autopilot/test/slice.cpp

#include "test_macros.hpp"
#include <matrix/math.hpp>

using matrix::Matrix;
using matrix::SquareMatrix;

int main()
{
    float data[9] = {0, 2, 3,
                     4, 5, 6,
                     7, 8, 10
                    };
    float data_check[6] = {
        4, 5, 6,
        7, 8, 10
    };
    SquareMatrix<float, 3> A(data);
    Matrix<float, 2, 3> B_check(data_check);
    Matrix<float, 2, 3> B(A.slice<2, 3>(1, 0));
    TEST(isEqual(B, B_check));

    float data_2[4] = {
        11, 12,
        13, 14
    };

    Matrix<float, 2, 2> C(data_2);
    A.set(C, 1, 1);

    float data_2_check[9] = {
        0, 2, 3,
        4, 11, 12,
        7, 13, 14
    };
    Matrix<float, 3, 3> D(data_2_check);
    TEST(isEqual(A, D));

    return 0;
}

/* vim: set et fenc=utf-8 ff=unix sts=0 sw=4 ts=4 : */