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

Merge branch 'beta_mavlink2' into mpc_local_pos_mavlink

Browse Source
This commit is contained in:
Anton Babushkin
2014-03-19 20:01:01 +04:00
parent 068b7526b7 295f87f22c
commit 9b71e660ad
49 changed files with 5122 additions and 4691 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/geo/geo.c
+8 -16
View File
@@ -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) {