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

Perform geo.cpp's mathlib calls in double point precision

Browse Source
This commit is contained in:
Kamil Ritz
2020-04-13 20:34:41 +02:00
committed by Lorenz Meier
parent a013bb9314
commit 1fa6870cd6
5 changed files with 19 additions and 109 deletions
Download Patch File Download Diff File Expand all files Collapse all files
mathlib/mathlib.h
+18 -7
View File
@@ -51,14 +51,25 @@
#define M_PI_2_F (M_PI / 2.0f)
#endif
namespace math {
// using namespace Eigen;
#ifndef M_PI
#define M_PI 3.141592653589793238462643383280
#endif
float min(float val1, float val2);
float max(float val1, float val2);
float constrain(float val, float min, float max);
float radians(float degrees);
float degrees(float radians);
namespace math {
template <typename Type>
Type min(Type val1, Type val2) { return (val1 < val2) ? val1 : val2; }
template <typename Type>
Type max(Type val1, Type val2) { return (val1 > val2) ? val1 : val2; }
template <typename Type>
Type constrain(Type val, Type min, Type max) { return (val < min) ? min : ((val > max) ? max : val); }
template <typename Type>
Type radians(Type degrees) { return (degrees / Type(180)) * Type(M_PI); }
template <typename Type>
Type degrees(Type radians) { return (radians * Type(180)) / Type(M_PI); }
} // namespace math
#else