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

Floating point comparison routines

Browse Source
This commit is contained in:
Pavel Kirienko
2014-08-27 17:57:10 +04:00
parent dca96fd21d
commit 6446d05446
6 changed files with 282 additions and 42 deletions
Download Patch File Download Diff File Expand all files Collapse all files
libuavcan/src/marshal/uc_float_spec.cpp
+3 -38
View File
@@ -14,59 +14,24 @@
# include <limits>
#endif
#undef signbit
#undef isnan
#undef isinf
namespace uavcan
{
/*
* IEEE754Converter
* Float16 conversion algorithm: http://half.sourceforge.net/ (MIT License)
*/
template <typename T>
static inline bool signbit(T arg)
{
#if UAVCAN_CPP_VERSION >= UAVCAN_CPP11
return std::signbit(arg);
#else
return arg < T(0) || (arg == T(0) && T(1) / arg < T(0));
#endif
}
template <typename T>
static inline bool isnan(T arg)
{
#if UAVCAN_CPP_VERSION >= UAVCAN_CPP11
return std::isnan(arg);
#else
// cppcheck-suppress duplicateExpression
return arg != arg;
#endif
}
template <typename T>
static inline bool isinf(T arg)
{
#if UAVCAN_CPP_VERSION >= UAVCAN_CPP11
return std::isinf(arg);
#else
return arg == NumericTraits<T>::infinity() || arg == -NumericTraits<T>::infinity();
#endif
}
uint16_t IEEE754Converter::nativeNonIeeeToHalf(float value)
{
uint16_t hbits = signbit(value) << 15;
uint16_t hbits = static_cast<uint16_t>(getSignBit(value)) << 15;
if (value == 0.0f)
{
return hbits;
}
if (isnan(value))
if (isNaN(value))
{
return hbits | 0x7FFFU;
}
if (isinf(value))
if (isInfinity(value))
{
return hbits | 0x7C00U;
}