LP-311 Remove basic/advanced stabilization tab auto-switch (autotune/txpid lock issues)
[librepilot.git] / ground / gcs / src / libs / eigen / test / eigen2support.cpp
blob1fa49a8c8743b4b9b6567c14170e9362de2314d4
1 // This file is part of Eigen, a lightweight C++ template library
2 // for linear algebra.
3 //
4 // Copyright (C) 2009 Gael Guennebaud <gael.guennebaud@inria.fr>
5 //
6 // This Source Code Form is subject to the terms of the Mozilla
7 // Public License v. 2.0. If a copy of the MPL was not distributed
8 // with this file, You can obtain one at http://mozilla.org/MPL/2.0/.
10 #define EIGEN2_SUPPORT
11 #define EIGEN_NO_EIGEN2_DEPRECATED_WARNING
13 #include "main.h"
15 template<typename MatrixType> void eigen2support(const MatrixType& m)
17 typedef typename MatrixType::Index Index;
18 typedef typename MatrixType::Scalar Scalar;
20 Index rows = m.rows();
21 Index cols = m.cols();
23 MatrixType m1 = MatrixType::Random(rows, cols),
24 m3(rows, cols);
26 Scalar s1 = internal::random<Scalar>(),
27 s2 = internal::random<Scalar>();
29 // scalar addition
30 VERIFY_IS_APPROX(m1.cwise() + s1, s1 + m1.cwise());
31 VERIFY_IS_APPROX(m1.cwise() + s1, MatrixType::Constant(rows,cols,s1) + m1);
32 VERIFY_IS_APPROX((m1*Scalar(2)).cwise() - s2, (m1+m1) - MatrixType::Constant(rows,cols,s2) );
33 m3 = m1;
34 m3.cwise() += s2;
35 VERIFY_IS_APPROX(m3, m1.cwise() + s2);
36 m3 = m1;
37 m3.cwise() -= s1;
38 VERIFY_IS_APPROX(m3, m1.cwise() - s1);
40 VERIFY_IS_EQUAL((m1.corner(TopLeft,1,1)), (m1.block(0,0,1,1)));
41 VERIFY_IS_EQUAL((m1.template corner<1,1>(TopLeft)), (m1.template block<1,1>(0,0)));
42 VERIFY_IS_EQUAL((m1.col(0).start(1)), (m1.col(0).segment(0,1)));
43 VERIFY_IS_EQUAL((m1.col(0).template start<1>()), (m1.col(0).segment(0,1)));
44 VERIFY_IS_EQUAL((m1.col(0).end(1)), (m1.col(0).segment(rows-1,1)));
45 VERIFY_IS_EQUAL((m1.col(0).template end<1>()), (m1.col(0).segment(rows-1,1)));
47 using std::cos;
48 using numext::real;
49 using numext::abs2;
50 VERIFY_IS_EQUAL(ei_cos(s1), cos(s1));
51 VERIFY_IS_EQUAL(ei_real(s1), real(s1));
52 VERIFY_IS_EQUAL(ei_abs2(s1), abs2(s1));
54 m1.minor(0,0);
57 void test_eigen2support()
59 for(int i = 0; i < g_repeat; i++) {
60 CALL_SUBTEST_1( eigen2support(Matrix<double,1,1>()) );
61 CALL_SUBTEST_2( eigen2support(MatrixXd(1,1)) );
62 CALL_SUBTEST_4( eigen2support(Matrix3f()) );
63 CALL_SUBTEST_5( eigen2support(Matrix4d()) );
64 CALL_SUBTEST_2( eigen2support(MatrixXf(200,200)) );
65 CALL_SUBTEST_6( eigen2support(MatrixXcd(100,100)) );