aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_Math: added locations_are_same(loc1,loc2) helper

Browse Source 
returns true if lat and lng are the same, ignores alt and options
This commit is contained in:
Tom Pittenger 2015-08-24 14:52:27 -07:00 committed by Andrew Tridgell
parent 1026e7df45
commit 4771d19073
2 changed files with 12 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/AP_Math/AP_Math.h
View File

@ -150,6 +150,11 @@ float wrap_180_cd_float(float angle);
*/ */
float wrap_PI(float angle_in_radians); float wrap_PI(float angle_in_radians);
/*
* check if lat and lng match. Ignore altitude and options
*/
bool locations_are_same(const struct Location &loc1, const struct Location &loc2);
/* /*
print a int32_t lat/long in decimal degrees print a int32_t lat/long in decimal degrees
*/ */

7
libraries/AP_Math/location.cpp
View File

@ -222,6 +222,13 @@ float wrap_PI(float angle_in_radians)
return angle_in_radians; return angle_in_radians;
} }
/*
return true if lat and lng match. Ignores altitude and options
*/
bool locations_are_same(const struct Location &loc1, const struct Location &loc2) {
return (loc1.lat == loc2.lat) && (loc1.lng == loc2.lng);
}
/* /*
print a int32_t lat/long in decimal degrees print a int32_t lat/long in decimal degrees
*/ */