GCC Code Coverage Report


Directory: ./
File: tests/math/matrix-homogeneous.cpp
Date: 2024-11-13 12:35:17
Exec Total Coverage
Lines: 59 59 100.0%
Branches: 237 444 53.4%

Line Branch Exec Source
1 // Copyright 2011 Florent Lamiraux
2
3 #include <sstream>
4
5 #define BOOST_TEST_MODULE matrix_homogeneous
6
7 #include <boost/math/constants/constants.hpp>
8 #include <boost/test/floating_point_comparison.hpp>
9 #include <boost/test/output_test_stream.hpp>
10 #include <boost/test/unit_test.hpp>
11 #include <sot/core/matrix-geometry.hh>
12
13 using boost::math::constants::pi;
14 using boost::test_tools::output_test_stream;
15
16 namespace dg = dynamicgraph;
17
18 #define MATRIX_BOOST_REQUIRE_CLOSE(N, M, LEFT, RIGHT, TOLERANCE) \
19 for (unsigned i = 0; i < N; ++i) \
20 for (unsigned j = 0; j < M; ++j) \
21 BOOST_REQUIRE_CLOSE(LEFT(i, j), RIGHT(i, j), TOLERANCE)
22
23 #define MATRIX_4x4_BOOST_REQUIRE_CLOSE(LEFT, RIGHT, TOLERANCE) \
24 MATRIX_BOOST_REQUIRE_CLOSE(4, 4, LEFT, RIGHT, TOLERANCE)
25
26 #define MATRIX_IDENTITY_4x4_REQUIRE_CLOSE(M, TOLERANCE) \
27 for (unsigned i = 0; i < 4; ++i) \
28 for (unsigned j = 0; j < 4; ++j) \
29 if (i == j) \
30 BOOST_REQUIRE_CLOSE(M(i, j), 1., TOLERANCE); \
31 else \
32 BOOST_CHECK_SMALL(M(i, j), .01 * TOLERANCE)
33
34 #define MATRIX_HOMO_INIT(M, tx, ty, tz, roll, pitch, yaw) \
35 M(0, 0) = cos(pitch) * cos(yaw); \
36 M(0, 1) = sin(roll) * sin(pitch) * cos(yaw) - cos(roll) * sin(yaw); \
37 M(0, 2) = cos(roll) * sin(pitch) * cos(yaw) + sin(roll) * sin(yaw); \
38 M(0, 3) = tx; \
39 M(1, 0) = cos(pitch) * sin(yaw); \
40 M(1, 1) = sin(roll) * sin(pitch) * sin(yaw) + cos(roll) * cos(yaw); \
41 M(1, 2) = cos(roll) * sin(pitch) * sin(yaw) - sin(roll) * cos(yaw); \
42 M(1, 3) = ty; \
43 M(2, 0) = -sin(pitch); \
44 M(2, 1) = sin(roll) * cos(pitch); \
45 M(2, 2) = cos(roll) * cos(pitch); \
46 M(2, 3) = tz; \
47 M(3, 0) = 0.; \
48 M(3, 1) = 0.; \
49 M(3, 2) = 0.; \
50 M(3, 3) = 1.
51
52
33/66
✓ Branch 1 taken 1 times.
✗ Branch 2 not taken.
✓ Branch 5 taken 1 times.
✗ Branch 6 not taken.
✓ Branch 8 taken 1 times.
✗ Branch 9 not taken.
✓ Branch 11 taken 1 times.
✗ Branch 12 not taken.
✓ Branch 14 taken 1 times.
✗ Branch 15 not taken.
✓ Branch 19 taken 1 times.
✗ Branch 20 not taken.
✓ Branch 23 taken 1 times.
✗ Branch 24 not taken.
✓ Branch 27 taken 1 times.
✗ Branch 28 not taken.
✓ Branch 30 taken 1 times.
✗ Branch 31 not taken.
✓ Branch 33 taken 1 times.
✗ Branch 34 not taken.
✓ Branch 36 taken 1 times.
✗ Branch 37 not taken.
✓ Branch 41 taken 1 times.
✗ Branch 42 not taken.
✓ Branch 45 taken 1 times.
✗ Branch 46 not taken.
✓ Branch 48 taken 1 times.
✗ Branch 49 not taken.
✓ Branch 52 taken 1 times.
✗ Branch 53 not taken.
✓ Branch 55 taken 1 times.
✗ Branch 56 not taken.
✓ Branch 58 taken 1 times.
✗ Branch 59 not taken.
✓ Branch 61 taken 1 times.
✗ Branch 62 not taken.
✓ Branch 66 taken 1 times.
✗ Branch 67 not taken.
✓ Branch 70 taken 1 times.
✗ Branch 71 not taken.
✓ Branch 73 taken 1 times.
✗ Branch 74 not taken.
✓ Branch 77 taken 1 times.
✗ Branch 78 not taken.
✓ Branch 80 taken 1 times.
✗ Branch 81 not taken.
✓ Branch 83 taken 1 times.
✗ Branch 84 not taken.
✓ Branch 86 taken 1 times.
✗ Branch 87 not taken.
✓ Branch 91 taken 1 times.
✗ Branch 92 not taken.
✓ Branch 95 taken 1 times.
✗ Branch 96 not taken.
✓ Branch 98 taken 1 times.
✗ Branch 99 not taken.
✓ Branch 102 taken 1 times.
✗ Branch 103 not taken.
✓ Branch 105 taken 1 times.
✗ Branch 106 not taken.
✓ Branch 108 taken 1 times.
✗ Branch 109 not taken.
✓ Branch 111 taken 1 times.
✗ Branch 112 not taken.
✓ Branch 116 taken 1 times.
✗ Branch 117 not taken.
4 BOOST_AUTO_TEST_CASE(product) {
53
2/2
✓ Branch 0 taken 1000 times.
✓ Branch 1 taken 1 times.
2002 for (unsigned int i = 0; i < 1000; i++) {
54 double tx, ty, tz;
55 double roll, pitch, yaw;
56
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous H1;
57 2000 tx = (10. * rand()) / RAND_MAX - 5.;
58 2000 ty = (10. * rand()) / RAND_MAX - 5.;
59 2000 tz = (10. * rand()) / RAND_MAX - 5.;
60 2000 roll = (pi<double>() * rand()) / RAND_MAX - .5 * pi<double>();
61 2000 pitch = (pi<double>() * rand()) / RAND_MAX - .5 * pi<double>();
62 2000 yaw = (2 * pi<double>() * rand()) / RAND_MAX - pi<double>();
63
16/32
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
✓ Branch 4 taken 1000 times.
✗ Branch 5 not taken.
✓ Branch 7 taken 1000 times.
✗ Branch 8 not taken.
✓ Branch 10 taken 1000 times.
✗ Branch 11 not taken.
✓ Branch 13 taken 1000 times.
✗ Branch 14 not taken.
✓ Branch 16 taken 1000 times.
✗ Branch 17 not taken.
✓ Branch 19 taken 1000 times.
✗ Branch 20 not taken.
✓ Branch 22 taken 1000 times.
✗ Branch 23 not taken.
✓ Branch 25 taken 1000 times.
✗ Branch 26 not taken.
✓ Branch 28 taken 1000 times.
✗ Branch 29 not taken.
✓ Branch 31 taken 1000 times.
✗ Branch 32 not taken.
✓ Branch 34 taken 1000 times.
✗ Branch 35 not taken.
✓ Branch 37 taken 1000 times.
✗ Branch 38 not taken.
✓ Branch 40 taken 1000 times.
✗ Branch 41 not taken.
✓ Branch 43 taken 1000 times.
✗ Branch 44 not taken.
✓ Branch 46 taken 1000 times.
✗ Branch 47 not taken.
2000 MATRIX_HOMO_INIT(H1, tx, ty, tz, roll, pitch, yaw);
64
1/2
✓ Branch 2 taken 1000 times.
✗ Branch 3 not taken.
2000 dg::Matrix M1(H1.matrix());
65
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous H2;
66 2000 tx = (10. * rand()) / RAND_MAX;
67 2000 ty = (10. * rand()) / RAND_MAX - 5.;
68 2000 tz = (10. * rand()) / RAND_MAX - 5.;
69 2000 roll = (pi<double>() * rand()) / RAND_MAX - .5 * pi<double>();
70 2000 pitch = (pi<double>() * rand()) / RAND_MAX - .5 * pi<double>();
71 2000 yaw = (2 * pi<double>() * rand()) / RAND_MAX - pi<double>();
72
16/32
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
✓ Branch 4 taken 1000 times.
✗ Branch 5 not taken.
✓ Branch 7 taken 1000 times.
✗ Branch 8 not taken.
✓ Branch 10 taken 1000 times.
✗ Branch 11 not taken.
✓ Branch 13 taken 1000 times.
✗ Branch 14 not taken.
✓ Branch 16 taken 1000 times.
✗ Branch 17 not taken.
✓ Branch 19 taken 1000 times.
✗ Branch 20 not taken.
✓ Branch 22 taken 1000 times.
✗ Branch 23 not taken.
✓ Branch 25 taken 1000 times.
✗ Branch 26 not taken.
✓ Branch 28 taken 1000 times.
✗ Branch 29 not taken.
✓ Branch 31 taken 1000 times.
✗ Branch 32 not taken.
✓ Branch 34 taken 1000 times.
✗ Branch 35 not taken.
✓ Branch 37 taken 1000 times.
✗ Branch 38 not taken.
✓ Branch 40 taken 1000 times.
✗ Branch 41 not taken.
✓ Branch 43 taken 1000 times.
✗ Branch 44 not taken.
✓ Branch 46 taken 1000 times.
✗ Branch 47 not taken.
2000 MATRIX_HOMO_INIT(H2, tx, ty, tz, roll, pitch, yaw);
73
1/2
✓ Branch 2 taken 1000 times.
✗ Branch 3 not taken.
2000 dg::Matrix M2(H2.matrix());
74
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous H3 = H1 * H2;
75
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dg::Matrix M3;
76
2/4
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
✓ Branch 4 taken 1000 times.
✗ Branch 5 not taken.
2000 M3 = M1 * M2;
77
78
12/20
✓ Branch 1 taken 16000 times.
✗ Branch 2 not taken.
✓ Branch 5 taken 16000 times.
✗ Branch 6 not taken.
✓ Branch 8 taken 16000 times.
✗ Branch 9 not taken.
✓ Branch 12 taken 16000 times.
✗ Branch 13 not taken.
✓ Branch 15 taken 16000 times.
✗ Branch 16 not taken.
✓ Branch 20 taken 16000 times.
✗ Branch 21 not taken.
✓ Branch 23 taken 16000 times.
✗ Branch 24 not taken.
✗ Branch 27 not taken.
✓ Branch 28 taken 16000 times.
✓ Branch 29 taken 16000 times.
✓ Branch 30 taken 4000 times.
✓ Branch 31 taken 4000 times.
✓ Branch 32 taken 1000 times.
42000 MATRIX_4x4_BOOST_REQUIRE_CLOSE(M3, H3.matrix(), 0.0001);
79 2000 }
80 2 }
81
82
33/66
✓ Branch 1 taken 1 times.
✗ Branch 2 not taken.
✓ Branch 5 taken 1 times.
✗ Branch 6 not taken.
✓ Branch 8 taken 1 times.
✗ Branch 9 not taken.
✓ Branch 11 taken 1 times.
✗ Branch 12 not taken.
✓ Branch 14 taken 1 times.
✗ Branch 15 not taken.
✓ Branch 19 taken 1 times.
✗ Branch 20 not taken.
✓ Branch 23 taken 1 times.
✗ Branch 24 not taken.
✓ Branch 27 taken 1 times.
✗ Branch 28 not taken.
✓ Branch 30 taken 1 times.
✗ Branch 31 not taken.
✓ Branch 33 taken 1 times.
✗ Branch 34 not taken.
✓ Branch 36 taken 1 times.
✗ Branch 37 not taken.
✓ Branch 41 taken 1 times.
✗ Branch 42 not taken.
✓ Branch 45 taken 1 times.
✗ Branch 46 not taken.
✓ Branch 48 taken 1 times.
✗ Branch 49 not taken.
✓ Branch 52 taken 1 times.
✗ Branch 53 not taken.
✓ Branch 55 taken 1 times.
✗ Branch 56 not taken.
✓ Branch 58 taken 1 times.
✗ Branch 59 not taken.
✓ Branch 61 taken 1 times.
✗ Branch 62 not taken.
✓ Branch 66 taken 1 times.
✗ Branch 67 not taken.
✓ Branch 70 taken 1 times.
✗ Branch 71 not taken.
✓ Branch 73 taken 1 times.
✗ Branch 74 not taken.
✓ Branch 77 taken 1 times.
✗ Branch 78 not taken.
✓ Branch 80 taken 1 times.
✗ Branch 81 not taken.
✓ Branch 83 taken 1 times.
✗ Branch 84 not taken.
✓ Branch 86 taken 1 times.
✗ Branch 87 not taken.
✓ Branch 91 taken 1 times.
✗ Branch 92 not taken.
✓ Branch 95 taken 1 times.
✗ Branch 96 not taken.
✓ Branch 98 taken 1 times.
✗ Branch 99 not taken.
✓ Branch 102 taken 1 times.
✗ Branch 103 not taken.
✓ Branch 105 taken 1 times.
✗ Branch 106 not taken.
✓ Branch 108 taken 1 times.
✗ Branch 109 not taken.
✓ Branch 111 taken 1 times.
✗ Branch 112 not taken.
✓ Branch 116 taken 1 times.
✗ Branch 117 not taken.
4 BOOST_AUTO_TEST_CASE(inverse) {
83
2/2
✓ Branch 0 taken 1000 times.
✓ Branch 1 taken 1 times.
2002 for (unsigned int i = 0; i < 1000; i++) {
84 double tx, ty, tz;
85 double roll, pitch, yaw;
86
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous H1;
87 2000 tx = (10. * rand()) / RAND_MAX - 5.;
88 2000 ty = (10. * rand()) / RAND_MAX - 5.;
89 2000 tz = (10. * rand()) / RAND_MAX - 5.;
90 2000 roll = (pi<double>() * rand()) / RAND_MAX - .5 * pi<double>();
91 2000 pitch = (pi<double>() * rand()) / RAND_MAX - .5 * pi<double>();
92 2000 yaw = (2 * pi<double>() * rand()) / RAND_MAX - pi<double>();
93
16/32
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
✓ Branch 4 taken 1000 times.
✗ Branch 5 not taken.
✓ Branch 7 taken 1000 times.
✗ Branch 8 not taken.
✓ Branch 10 taken 1000 times.
✗ Branch 11 not taken.
✓ Branch 13 taken 1000 times.
✗ Branch 14 not taken.
✓ Branch 16 taken 1000 times.
✗ Branch 17 not taken.
✓ Branch 19 taken 1000 times.
✗ Branch 20 not taken.
✓ Branch 22 taken 1000 times.
✗ Branch 23 not taken.
✓ Branch 25 taken 1000 times.
✗ Branch 26 not taken.
✓ Branch 28 taken 1000 times.
✗ Branch 29 not taken.
✓ Branch 31 taken 1000 times.
✗ Branch 32 not taken.
✓ Branch 34 taken 1000 times.
✗ Branch 35 not taken.
✓ Branch 37 taken 1000 times.
✗ Branch 38 not taken.
✓ Branch 40 taken 1000 times.
✗ Branch 41 not taken.
✓ Branch 43 taken 1000 times.
✗ Branch 44 not taken.
✓ Branch 46 taken 1000 times.
✗ Branch 47 not taken.
2000 MATRIX_HOMO_INIT(H1, tx, ty, tz, roll, pitch, yaw);
94
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous H2;
95 2000 tx = (10. * rand()) / RAND_MAX;
96 2000 ty = (10. * rand()) / RAND_MAX - 5.;
97 2000 tz = (10. * rand()) / RAND_MAX - 5.;
98 2000 roll = (pi<double>() * rand()) / RAND_MAX - .5 * pi<double>();
99 2000 pitch = (pi<double>() * rand()) / RAND_MAX - .5 * pi<double>();
100 2000 yaw = (2 * pi<double>() * rand()) / RAND_MAX - pi<double>();
101
16/32
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
✓ Branch 4 taken 1000 times.
✗ Branch 5 not taken.
✓ Branch 7 taken 1000 times.
✗ Branch 8 not taken.
✓ Branch 10 taken 1000 times.
✗ Branch 11 not taken.
✓ Branch 13 taken 1000 times.
✗ Branch 14 not taken.
✓ Branch 16 taken 1000 times.
✗ Branch 17 not taken.
✓ Branch 19 taken 1000 times.
✗ Branch 20 not taken.
✓ Branch 22 taken 1000 times.
✗ Branch 23 not taken.
✓ Branch 25 taken 1000 times.
✗ Branch 26 not taken.
✓ Branch 28 taken 1000 times.
✗ Branch 29 not taken.
✓ Branch 31 taken 1000 times.
✗ Branch 32 not taken.
✓ Branch 34 taken 1000 times.
✗ Branch 35 not taken.
✓ Branch 37 taken 1000 times.
✗ Branch 38 not taken.
✓ Branch 40 taken 1000 times.
✗ Branch 41 not taken.
✓ Branch 43 taken 1000 times.
✗ Branch 44 not taken.
✓ Branch 46 taken 1000 times.
✗ Branch 47 not taken.
2000 MATRIX_HOMO_INIT(H2, tx, ty, tz, roll, pitch, yaw);
102
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous H3 = H1 * H2;
103
3/6
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
✓ Branch 4 taken 1000 times.
✗ Branch 5 not taken.
✓ Branch 7 taken 1000 times.
✗ Branch 8 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous invH1, invH2, invH3;
104
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 invH1 = H1.inverse();
105
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 invH2 = H2.inverse();
106
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 invH3 = H3.inverse();
107
108
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous I4;
109
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous P1 = H1 * invH1;
110
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous P2 = H2 * invH2;
111
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous P3 = H3 * invH3;
112
1/2
✓ Branch 1 taken 1000 times.
✗ Branch 2 not taken.
2000 dynamicgraph::sot::MatrixHomogeneous P4 = invH2 * invH1;
113
114
19/32
✓ Branch 0 taken 4000 times.
✓ Branch 1 taken 12000 times.
✓ Branch 3 taken 4000 times.
✗ Branch 4 not taken.
✓ Branch 7 taken 4000 times.
✗ Branch 8 not taken.
✓ Branch 10 taken 4000 times.
✗ Branch 11 not taken.
✓ Branch 13 taken 4000 times.
✗ Branch 14 not taken.
✓ Branch 18 taken 4000 times.
✗ Branch 19 not taken.
✓ Branch 21 taken 4000 times.
✗ Branch 22 not taken.
✗ Branch 25 not taken.
✓ Branch 26 taken 4000 times.
✓ Branch 28 taken 12000 times.
✗ Branch 29 not taken.
✓ Branch 32 taken 12000 times.
✗ Branch 33 not taken.
✓ Branch 35 taken 12000 times.
✗ Branch 36 not taken.
✓ Branch 40 taken 12000 times.
✗ Branch 41 not taken.
✓ Branch 43 taken 12000 times.
✗ Branch 44 not taken.
✗ Branch 47 not taken.
✓ Branch 48 taken 12000 times.
✓ Branch 49 taken 16000 times.
✓ Branch 50 taken 4000 times.
✓ Branch 51 taken 4000 times.
✓ Branch 52 taken 1000 times.
42000 MATRIX_IDENTITY_4x4_REQUIRE_CLOSE(P1, 0.0001);
115
19/32
✓ Branch 0 taken 4000 times.
✓ Branch 1 taken 12000 times.
✓ Branch 3 taken 4000 times.
✗ Branch 4 not taken.
✓ Branch 7 taken 4000 times.
✗ Branch 8 not taken.
✓ Branch 10 taken 4000 times.
✗ Branch 11 not taken.
✓ Branch 13 taken 4000 times.
✗ Branch 14 not taken.
✓ Branch 18 taken 4000 times.
✗ Branch 19 not taken.
✓ Branch 21 taken 4000 times.
✗ Branch 22 not taken.
✗ Branch 25 not taken.
✓ Branch 26 taken 4000 times.
✓ Branch 28 taken 12000 times.
✗ Branch 29 not taken.
✓ Branch 32 taken 12000 times.
✗ Branch 33 not taken.
✓ Branch 35 taken 12000 times.
✗ Branch 36 not taken.
✓ Branch 40 taken 12000 times.
✗ Branch 41 not taken.
✓ Branch 43 taken 12000 times.
✗ Branch 44 not taken.
✗ Branch 47 not taken.
✓ Branch 48 taken 12000 times.
✓ Branch 49 taken 16000 times.
✓ Branch 50 taken 4000 times.
✓ Branch 51 taken 4000 times.
✓ Branch 52 taken 1000 times.
42000 MATRIX_IDENTITY_4x4_REQUIRE_CLOSE(P2, 0.0001);
116
19/32
✓ Branch 0 taken 4000 times.
✓ Branch 1 taken 12000 times.
✓ Branch 3 taken 4000 times.
✗ Branch 4 not taken.
✓ Branch 7 taken 4000 times.
✗ Branch 8 not taken.
✓ Branch 10 taken 4000 times.
✗ Branch 11 not taken.
✓ Branch 13 taken 4000 times.
✗ Branch 14 not taken.
✓ Branch 18 taken 4000 times.
✗ Branch 19 not taken.
✓ Branch 21 taken 4000 times.
✗ Branch 22 not taken.
✗ Branch 25 not taken.
✓ Branch 26 taken 4000 times.
✓ Branch 28 taken 12000 times.
✗ Branch 29 not taken.
✓ Branch 32 taken 12000 times.
✗ Branch 33 not taken.
✓ Branch 35 taken 12000 times.
✗ Branch 36 not taken.
✓ Branch 40 taken 12000 times.
✗ Branch 41 not taken.
✓ Branch 43 taken 12000 times.
✗ Branch 44 not taken.
✗ Branch 47 not taken.
✓ Branch 48 taken 12000 times.
✓ Branch 49 taken 16000 times.
✓ Branch 50 taken 4000 times.
✓ Branch 51 taken 4000 times.
✓ Branch 52 taken 1000 times.
42000 MATRIX_IDENTITY_4x4_REQUIRE_CLOSE(P3, 0.0001);
117
12/20
✓ Branch 1 taken 16000 times.
✗ Branch 2 not taken.
✓ Branch 5 taken 16000 times.
✗ Branch 6 not taken.
✓ Branch 8 taken 16000 times.
✗ Branch 9 not taken.
✓ Branch 11 taken 16000 times.
✗ Branch 12 not taken.
✓ Branch 14 taken 16000 times.
✗ Branch 15 not taken.
✓ Branch 19 taken 16000 times.
✗ Branch 20 not taken.
✓ Branch 22 taken 16000 times.
✗ Branch 23 not taken.
✗ Branch 26 not taken.
✓ Branch 27 taken 16000 times.
✓ Branch 28 taken 16000 times.
✓ Branch 29 taken 4000 times.
✓ Branch 30 taken 4000 times.
✓ Branch 31 taken 1000 times.
42000 MATRIX_4x4_BOOST_REQUIRE_CLOSE(P4, invH3, 0.0001);
118 }
119 2 }
120