fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-15 02:03:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

Matrix: use existing print() if isEqual test fails

Browse Source
This commit is contained in:
Matthias Grob
2019-09-05 10:19:47 +02:00
parent 938274fce5
commit 31450c407c
1 changed files with 5 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/Matrix.hpp
+5 -9
View File
@@ -550,7 +550,6 @@ Matrix<Type, M, N> operator*(Type scalar, const Matrix<Type, M, N> &other)
template<typename Type, size_t M, size_t N>
bool isEqual(const Matrix<Type, M, N> &x,
const Matrix<Type, M, N> &y, const Type eps=1e-4f) {
bool equal = true;
for (size_t i = 0; i < M; i++) {
@@ -563,16 +562,13 @@ bool isEqual(const Matrix<Type, M, N> &x,
if (equal == false) break;
}
if (!equal) {
static const size_t n = 10*N*M;
char * buf = new char[n];
x.write_string(buf, n);
printf("not equal\nx:\n%s\n", buf);
y.write_string(buf, n);
printf("y:\n%s\n", buf);
delete[] buf;
printf("not equal\nx:\n");
x.print();
printf("y:\n");
y.print();
}
return equal;
}