Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-22 07:44:03 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_GPS: move print_latlon into sole caller

Browse Source
This commit is contained in:
Peter Barker 2019-03-23 13:48:07 +11:00 committed by Andrew Tridgell
parent 431bd77d7e
commit 81d51b1d1a
1 changed files with 22 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

22
libraries/AP_GPS/examples/GPS_AUTO_test/GPS_AUTO_test.cpp
View File

@ -60,6 +60,28 @@ void setup()
gps.init(serial_manager); gps.init(serial_manager);
} }
/*
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);
}
void loop() void loop()
{ {
static uint32_t last_msg_ms; static uint32_t last_msg_ms;