Browse Source

AP_Math: move print_latlon into sole caller

master
Peter Barker 6 years ago committed by Andrew Tridgell
parent
commit
431bd77d7e
  1. 21
      libraries/AP_Math/location.cpp
  2. 5
      libraries/AP_Math/location.h

21
libraries/AP_Math/location.cpp

@ -156,27 +156,6 @@ bool location_sanitize(const struct Location &defaultLoc, struct Location &loc) @@ -156,27 +156,6 @@ bool location_sanitize(const struct Location &defaultLoc, struct Location &loc)
return has_changed;
}
/*
print a int32_t lat/long in decimal degrees
*/
void print_latlon(AP_HAL::BetterStream *s, int32_t lat_or_lon)
{
int32_t dec_portion, frac_portion;
int32_t abs_lat_or_lon = labs(lat_or_lon);
// extract decimal portion (special handling of negative numbers to ensure we round towards zero)
dec_portion = abs_lat_or_lon / 10000000UL;
// extract fractional portion
frac_portion = abs_lat_or_lon - dec_portion*10000000UL;
// print output including the minus sign
if( lat_or_lon < 0 ) {
s->printf("-");
}
s->printf("%ld.%07ld",(long)dec_portion,(long)frac_portion);
}
// return true when lat and lng are within range
bool check_lat(float lat)
{

5
libraries/AP_Math/location.h

@ -69,11 +69,6 @@ bool locations_are_same(const struct Location &loc1, const struct Locatio @@ -69,11 +69,6 @@ bool locations_are_same(const struct Location &loc1, const struct Locatio
*/
bool location_sanitize(const struct Location &defaultLoc, struct Location &loc);
/*
print a int32_t lat/long in decimal degrees
*/
void print_latlon(AP_HAL::BetterStream *s, int32_t lat_or_lon);
// Converts from WGS84 geodetic coordinates (lat, lon, height)
// into WGS84 Earth Centered, Earth Fixed (ECEF) coordinates
// (X, Y, Z)

Loading…
Cancel
Save