diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2014-03-11 17:53:42 +0100 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2014-03-11 17:53:42 +0100 |
commit | 5a39a4cbd4621fa64d430e7881dcac57928f337f (patch) | |
tree | 01b6e45b876a4f513082d27174e0f6249f756788 /src/lib/geo | |
parent | ebab4bfa7ef9ca138ac476943a87b8e3244b9a21 (diff) | |
parent | 0bcda7f8a6079ba20eeb4bbd4181872a5513acfc (diff) | |
download | px4-firmware-5a39a4cbd4621fa64d430e7881dcac57928f337f.tar.gz px4-firmware-5a39a4cbd4621fa64d430e7881dcac57928f337f.tar.bz2 px4-firmware-5a39a4cbd4621fa64d430e7881dcac57928f337f.zip |
Merged mavlink_beta2
Diffstat (limited to 'src/lib/geo')
-rw-r--r-- | src/lib/geo/geo.c | 16 |
1 files changed, 8 insertions, 8 deletions
diff --git a/src/lib/geo/geo.c b/src/lib/geo/geo.c index 34285e2bf..f72dc607c 100644 --- a/src/lib/geo/geo.c +++ b/src/lib/geo/geo.c @@ -440,14 +440,14 @@ __EXPORT float _wrap_pi(float bearing) } int c = 0; - while (bearing > M_PI_F) { + while (bearing >= M_PI_F) { bearing -= M_TWOPI_F; if (c++ > 3) return NAN; } c = 0; - while (bearing <= -M_PI_F) { + while (bearing < -M_PI_F) { bearing += M_TWOPI_F; if (c++ > 3) return NAN; @@ -464,14 +464,14 @@ __EXPORT float _wrap_2pi(float bearing) } int c = 0; - while (bearing > M_TWOPI_F) { + while (bearing >= M_TWOPI_F) { bearing -= M_TWOPI_F; if (c++ > 3) return NAN; } c = 0; - while (bearing <= 0.0f) { + while (bearing < 0.0f) { bearing += M_TWOPI_F; if (c++ > 3) return NAN; @@ -488,14 +488,14 @@ __EXPORT float _wrap_180(float bearing) } int c = 0; - while (bearing > 180.0f) { + while (bearing >= 180.0f) { bearing -= 360.0f; if (c++ > 3) return NAN; } c = 0; - while (bearing <= -180.0f) { + while (bearing < -180.0f) { bearing += 360.0f; if (c++ > 3) return NAN; @@ -512,14 +512,14 @@ __EXPORT float _wrap_360(float bearing) } int c = 0; - while (bearing > 360.0f) { + while (bearing >= 360.0f) { bearing -= 360.0f; if (c++ > 3) return NAN; } c = 0; - while (bearing <= 0.0f) { + while (bearing < 0.0f) { bearing += 360.0f; if (c++ > 3) return NAN; |