px4_autopilot/test/vector2.cpp

#include <stdio.h>

#include <matrix/math.hpp>

#include "test_macros.hpp"

using namespace matrix;

template class Vector<float, 2>;

int main()
{
    Vector2f a(1, 0);
    Vector2f b(0, 1);
    TEST(fabs(a % b - 1.0f) < 1e-5);

    Vector2f c;
    TEST(fabs(c(0) - 0) < 1e-5);
    TEST(fabs(c(1) - 0) < 1e-5);

    Matrix<float, 2, 1> d(a);
    TEST(fabs(d(0,0) - 1) < 1e-5);
    TEST(fabs(d(1,0) - 0) < 1e-5);

    Vector2f e(d);
    TEST(fabs(e(0) - 1) < 1e-5);
    TEST(fabs(e(1) - 0) < 1e-5);

    float data[] = {4,5};
    Vector2f f(data);
    TEST(fabs(f(0) - 4) < 1e-5);
    TEST(fabs(f(1) - 5) < 1e-5);

    return 0;
}

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