Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-22 08:38:36 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Math: added double_to_int32 and double_to_uint32

Browse Source
This commit is contained in:
Andrew Tridgell 2022-07-21 11:26:09 +10:00
parent 3c232d1f67
commit e1c006c25d
2 changed files with 17 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
libraries/AP_Math/AP_Math.cpp
View File

@ -510,3 +510,13 @@ uint32_t float_to_uint32(const float v)
{
return uint32_t(constrain_float(v, 0, UINT32_MAX));
}
uint32_t double_to_uint32(const double v)
{
return uint32_t(constrain_double(v, 0, UINT32_MAX));
}
int32_t double_to_int32(const double v)
{
return int32_t(constrain_double(v, INT32_MIN, UINT32_MAX));
}

7
libraries/AP_Math/AP_Math.h
View File

@ -204,6 +204,11 @@ inline uint64_t constrain_uint64(const uint64_t amt, const uint64_t low, const u
return constrain_value(amt, low, high);
}
inline double constrain_double(const double amt, const double low, const double high)
{
return constrain_value(amt, low, high);
}
// degrees -> radians
static inline constexpr ftype radians(ftype deg)
{
@ -367,4 +372,6 @@ int16_t float_to_int16(const float v);
uint16_t float_to_uint16(const float v);
int32_t float_to_int32(const float v);
uint32_t float_to_uint32(const float v);
uint32_t double_to_uint32(const double v);
int32_t double_to_int32(const double v);