mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-27 17:00:04 +08:00
Matrix add == and != operators
This commit is contained in:
@@ -288,6 +288,29 @@ public:
|
||||
*this = (*this) - scalar;
|
||||
}
|
||||
|
||||
bool operator==(const Matrix<Type, M, N> &other) const
|
||||
{
|
||||
const Matrix<Type, M, N> &self = *this;
|
||||
|
||||
// TODO: set this based on Type
|
||||
static constexpr float eps = 1e-4f;
|
||||
|
||||
for (size_t i = 0; i < M; i++) {
|
||||
for (size_t j = 0; j < N; j++) {
|
||||
if (fabs(self(i, j) - other(i, j) > eps) ) {
|
||||
return false;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
bool operator!=(const Matrix<Type, M, N> &other) const
|
||||
{
|
||||
const Matrix<Type, M, N> &self = *this;
|
||||
return !(self == other);
|
||||
}
|
||||
|
||||
/**
|
||||
* Misc. Functions
|
||||
|
||||
Reference in New Issue
Block a user