diff options
author | Anton Babushkin <anton.babushkin@me.com> | 2014-03-19 20:01:01 +0400 |
---|---|---|
committer | Anton Babushkin <anton.babushkin@me.com> | 2014-03-19 20:01:01 +0400 |
commit | 9b71e660ad86cb2ecec4db93795f417a9ba0fddd (patch) | |
tree | c7bd62f4e4b260f03c6103e9d322e2b3f84d11c2 /src/lib/geo/geo.c | |
parent | 068b7526b74c9bbcc31acc28f0d578ed9c0f97b1 (diff) | |
parent | 295f87f22cc471fccb44e3f3dee3e8fcab263de2 (diff) | |
download | px4-firmware-9b71e660ad86cb2ecec4db93795f417a9ba0fddd.tar.gz px4-firmware-9b71e660ad86cb2ecec4db93795f417a9ba0fddd.tar.bz2 px4-firmware-9b71e660ad86cb2ecec4db93795f417a9ba0fddd.zip |
Merge branch 'beta_mavlink2' into mpc_local_pos_mavlink
Diffstat (limited to 'src/lib/geo/geo.c')
-rw-r--r-- | src/lib/geo/geo.c | 24 |
1 files changed, 8 insertions, 16 deletions
diff --git a/src/lib/geo/geo.c b/src/lib/geo/geo.c index abed7eb1f..373a22686 100644 --- a/src/lib/geo/geo.c +++ b/src/lib/geo/geo.c @@ -373,8 +373,7 @@ __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) { @@ -383,8 +382,7 @@ __EXPORT float _wrap_pi(float bearing) } c = 0; - - while (bearing <= -M_PI_F) { + while (bearing < -M_PI_F) { bearing += M_TWOPI_F; if (c++ > 3) { @@ -403,8 +401,7 @@ __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) { @@ -413,8 +410,7 @@ __EXPORT float _wrap_2pi(float bearing) } c = 0; - - while (bearing <= 0.0f) { + while (bearing < 0.0f) { bearing += M_TWOPI_F; if (c++ > 3) { @@ -433,8 +429,7 @@ __EXPORT float _wrap_180(float bearing) } int c = 0; - - while (bearing > 180.0f) { + while (bearing >= 180.0f) { bearing -= 360.0f; if (c++ > 3) { @@ -443,8 +438,7 @@ __EXPORT float _wrap_180(float bearing) } c = 0; - - while (bearing <= -180.0f) { + while (bearing < -180.0f) { bearing += 360.0f; if (c++ > 3) { @@ -463,8 +457,7 @@ __EXPORT float _wrap_360(float bearing) } int c = 0; - - while (bearing > 360.0f) { + while (bearing >= 360.0f) { bearing -= 360.0f; if (c++ > 3) { @@ -473,8 +466,7 @@ __EXPORT float _wrap_360(float bearing) } c = 0; - - while (bearing <= 0.0f) { + while (bearing < 0.0f) { bearing += 360.0f; if (c++ > 3) { |