Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-24 15:40:31 +08:00
Code Issues Actions 7 Packages Projects Releases Wiki Activity

matrix: adjust printing for if symmetric (lower triangular only)

Browse Source
This commit is contained in:
Daniel Agar
2024-01-16 10:20:21 -05:00
committed by GitHub
parent 64f28c4c07
commit c3ae7b28c0
1 changed files with 18 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/matrix/matrix/Matrix.hpp
+18 -9
View File
@@ -365,7 +365,7 @@ public:
}
}
void print(float eps = 0.00001f) const
void print(float eps = 1e-9) const
{
// print column numbering
if (N > 1) {
@@ -393,16 +393,25 @@ public:
printf("\033[1m");
}
// avoid -0.0 for display
if (fabs(d - 0.0) < (double)eps) {
// print fixed width zero
printf(" 0 ");
} else if ((fabs(d) < 1e-4) || (fabs(d) >= 10.0)) {
printf("% .1e ", d);
// if symmetric don't print upper triangular elements
if ((M == N) && (j > i) && (i < N) && (j < M)
&& (fabs(d - static_cast<double>(self(j, i))) < (double)eps)
) {
// print empty space
printf(" ");
} else {
printf("% 6.5f ", d);
// avoid -0.0 for display
if (fabs(d - 0.0) < (double)eps) {
// print fixed width zero
printf(" 0 ");
} else if ((fabs(d) < 1e-4) || (fabs(d) >= 10.0)) {
printf("% .1e ", d);
} else {
printf("% 6.5f ", d);
}
}
// Matrix diagonal elements