Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-22 06:14:14 +08:00
Code Issues Actions 8 Packages Projects Releases Wiki Activity

Coerce default epsilon values to Type

Browse Source
This commit is contained in:
Julian Kent
2021-01-13 09:57:23 +01:00
committed by Julian Kent
parent 054f8b12f4
commit d540ca5de2
3 changed files with 5 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/Matrix.hpp
+1 -1
View File
@@ -605,7 +605,7 @@ Matrix<Type, M, N> operator*(Type scalar, const Matrix<Type, M, N> &other)
template<typename Type, size_t M, size_t N> template<typename Type, size_t M, size_t N>
bool isEqual(const Matrix<Type, M, N> &x, bool isEqual(const Matrix<Type, M, N> &x,
const Matrix<Type, M, N> &y, const Type eps=1e-4f) { const Matrix<Type, M, N> &y, const Type eps=Type(1e-4f)) {
for (size_t i = 0; i < M; i++) { for (size_t i = 0; i < M; i++) {
for (size_t j = 0; j < N; j++) { for (size_t j = 0; j < N; j++) {
if (!isEqualF(x(i,j), y(i,j), eps)) { if (!isEqualF(x(i,j), y(i,j), eps)) {
matrix/SquareMatrix.hpp
+3 -3
View File
@@ -223,7 +223,7 @@ public:
// checks if block diagonal is symmetric // checks if block diagonal is symmetric
template <size_t Width> template <size_t Width>
bool isBlockSymmetric(size_t first, const Type eps = 1e-8f) bool isBlockSymmetric(size_t first, const Type eps = Type(1e-8f))
{ {
static_assert(Width <= M, "Width bigger than matrix"); static_assert(Width <= M, "Width bigger than matrix");
assert(first + Width <= M); assert(first + Width <= M);
@@ -243,7 +243,7 @@ public:
// checks if rows and columns are symmetric // checks if rows and columns are symmetric
template <size_t Width> template <size_t Width>
bool isRowColSymmetric(size_t first, const Type eps = 1e-8f) bool isRowColSymmetric(size_t first, const Type eps = Type(1e-8f))
{ {
static_assert(Width <= M, "Width bigger than matrix"); static_assert(Width <= M, "Width bigger than matrix");
assert(first + Width <= M); assert(first + Width <= M);
@@ -324,7 +324,7 @@ bool inv(const SquareMatrix<Type, M> & A, SquareMatrix<Type, M> & inv, size_t ra
for (size_t i = n + 1; i < rank; i++) { for (size_t i = n + 1; i < rank; i++) {
//printf("\ttrying row %d\n",i); //printf("\ttrying row %d\n",i);
if (fabs(static_cast<float>(U(i, n))) > 1e-8f) { if (fabs(static_cast<float>(U(i, n))) > Type(1e-8f)) {
//printf("swapped %d\n",i); //printf("swapped %d\n",i);
U.swapRows(i, n); U.swapRows(i, n);
P.swapRows(i, n); P.swapRows(i, n);
matrix/helper_functions.hpp
+1 -1
View File
@@ -32,7 +32,7 @@ bool is_finite(Type x) {
* @return true if the two values are considered equal, false otherwise * @return true if the two values are considered equal, false otherwise
*/ */
template<typename Type> template<typename Type>
bool isEqualF(const Type x, const Type y, const Type eps = 1e-4f) bool isEqualF(const Type x, const Type y, const Type eps = Type(1e-4f))
{ {
return (matrix::fabs(x - y) <= eps) return (matrix::fabs(x - y) <= eps)
|| (isnan(x) && isnan(y)) || (isnan(x) && isnan(y))