MCPcopy Create free account
hub / github.com/PX4/eigen / diagonal

Function diagonal

test/diagonal.cpp:12–69  ·  view source on GitHub ↗

Source from the content-addressed store, hash-verified

10#include "main.h"
11
12template<typename MatrixType> void diagonal(const MatrixType& m)
13{
14 typedef typename MatrixType::Index Index;
15 typedef typename MatrixType::Scalar Scalar;
16
17 Index rows = m.rows();
18 Index cols = m.cols();
19
20 MatrixType m1 = MatrixType::Random(rows, cols),
21 m2 = MatrixType::Random(rows, cols);
22
23 Scalar s1 = internal::random<Scalar>();
24
25 //check diagonal()
26 VERIFY_IS_APPROX(m1.diagonal(), m1.transpose().diagonal());
27 m2.diagonal() = 2 * m1.diagonal();
28 m2.diagonal()[0] *= 3;
29
30 if (rows>2)
31 {
32 enum {
33 N1 = MatrixType::RowsAtCompileTime>2 ? 2 : 0,
34 N2 = MatrixType::RowsAtCompileTime>1 ? -1 : 0
35 };
36
37 // check sub/super diagonal
38 if(MatrixType::SizeAtCompileTime!=Dynamic)
39 {
40 VERIFY(m1.template diagonal<N1>().RowsAtCompileTime == m1.diagonal(N1).size());
41 VERIFY(m1.template diagonal<N2>().RowsAtCompileTime == m1.diagonal(N2).size());
42 }
43
44 m2.template diagonal<N1>() = 2 * m1.template diagonal<N1>();
45 VERIFY_IS_APPROX(m2.template diagonal<N1>(), static_cast<Scalar>(2) * m1.diagonal(N1));
46 m2.template diagonal<N1>()[0] *= 3;
47 VERIFY_IS_APPROX(m2.template diagonal<N1>()[0], static_cast<Scalar>(6) * m1.template diagonal<N1>()[0]);
48
49
50 m2.template diagonal<N2>() = 2 * m1.template diagonal<N2>();
51 m2.template diagonal<N2>()[0] *= 3;
52 VERIFY_IS_APPROX(m2.template diagonal<N2>()[0], static_cast<Scalar>(6) * m1.template diagonal<N2>()[0]);
53
54 m2.diagonal(N1) = 2 * m1.diagonal(N1);
55 VERIFY_IS_APPROX(m2.template diagonal<N1>(), static_cast<Scalar>(2) * m1.diagonal(N1));
56 m2.diagonal(N1)[0] *= 3;
57 VERIFY_IS_APPROX(m2.diagonal(N1)[0], static_cast<Scalar>(6) * m1.diagonal(N1)[0]);
58
59 m2.diagonal(N2) = 2 * m1.diagonal(N2);
60 VERIFY_IS_APPROX(m2.template diagonal<N2>(), static_cast<Scalar>(2) * m1.diagonal(N2));
61 m2.diagonal(N2)[0] *= 3;
62 VERIFY_IS_APPROX(m2.diagonal(N2)[0], static_cast<Scalar>(6) * m1.diagonal(N2)[0]);
63
64 m2.diagonal(N2).x() = s1;
65 VERIFY_IS_APPROX(m2.diagonal(N2).x(), s1);
66 m2.diagonal(N2).coeffRef(0) = Scalar(2)*s1;
67 VERIFY_IS_APPROX(m2.diagonal(N2).coeff(0), Scalar(2)*s1);
68 }
69}

Callers 6

evalToMethod · 0.85
rowsMethod · 0.85
colsMethod · 0.85
inverseMethod · 0.85
operator*Method · 0.85
test_diagonalFunction · 0.85

Calls 8

rowsMethod · 0.45
colsMethod · 0.45
diagonalMethod · 0.45
transposeMethod · 0.45
sizeMethod · 0.45
xMethod · 0.45
coeffRefMethod · 0.45
coeffMethod · 0.45

Tested by 1

test_diagonalFunction · 0.68