mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 07:03:33 +08:00
helper: consider NAN equal to NAN such that vectors can be compared exactly
This commit is contained in:
committed by
Julian Kent
parent
33a629105c
commit
bbaa93880b
@@ -34,7 +34,9 @@ bool is_finite(Type x) {
|
||||
template<typename Type>
|
||||
bool isEqualF(const Type x, const Type y, const Type eps = 1e-4f)
|
||||
{
|
||||
return matrix::fabs(x - y) <= eps;
|
||||
return (matrix::fabs(x - y) <= eps)
|
||||
|| (isnan(x) && isnan(y))
|
||||
|| (isinf(x) && isinf(y));
|
||||
}
|
||||
|
||||
/**
|
||||
|
||||
Reference in New Issue
Block a user