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

geo: _wrap_XXX minor fix

Browse Source
This commit is contained in:
Anton Babushkin
2014-02-26 22:46:33 +04:00
parent 2967763b16
commit f9619e3934
1 changed files with 8 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/geo/geo.c
+8 -8
View File
@@ -441,14 +441,14 @@ __EXPORT float _wrap_pi(float bearing)
} }
int c = 0; int c = 0;
while (bearing > M_PI_F) { while (bearing >= M_PI_F) {
bearing -= M_TWOPI_F; bearing -= M_TWOPI_F;
if (c++ > 3) if (c++ > 3)
return NAN; return NAN;
} }
c = 0; c = 0;
while (bearing <= -M_PI_F) { while (bearing < -M_PI_F) {
bearing += M_TWOPI_F; bearing += M_TWOPI_F;
if (c++ > 3) if (c++ > 3)
return NAN; return NAN;
@@ -465,14 +465,14 @@ __EXPORT float _wrap_2pi(float bearing)
} }
int c = 0; int c = 0;
while (bearing > M_TWOPI_F) { while (bearing >= M_TWOPI_F) {
bearing -= M_TWOPI_F; bearing -= M_TWOPI_F;
if (c++ > 3) if (c++ > 3)
return NAN; return NAN;
} }
c = 0; c = 0;
while (bearing <= 0.0f) { while (bearing < 0.0f) {
bearing += M_TWOPI_F; bearing += M_TWOPI_F;
if (c++ > 3) if (c++ > 3)
return NAN; return NAN;
@@ -489,14 +489,14 @@ __EXPORT float _wrap_180(float bearing)
} }
int c = 0; int c = 0;
while (bearing > 180.0f) { while (bearing >= 180.0f) {
bearing -= 360.0f; bearing -= 360.0f;
if (c++ > 3) if (c++ > 3)
return NAN; return NAN;
} }
c = 0; c = 0;
while (bearing <= -180.0f) { while (bearing < -180.0f) {
bearing += 360.0f; bearing += 360.0f;
if (c++ > 3) if (c++ > 3)
return NAN; return NAN;
@@ -513,14 +513,14 @@ __EXPORT float _wrap_360(float bearing)
} }
int c = 0; int c = 0;
while (bearing > 360.0f) { while (bearing >= 360.0f) {
bearing -= 360.0f; bearing -= 360.0f;
if (c++ > 3) if (c++ > 3)
return NAN; return NAN;
} }
c = 0; c = 0;
while (bearing <= 0.0f) { while (bearing < 0.0f) {
bearing += 360.0f; bearing += 360.0f;
if (c++ > 3) if (c++ > 3)
return NAN; return NAN;