mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-02-21 15:23:57 -04:00
AP_GPS: move print_latlon into sole caller
This commit is contained in:
parent
431bd77d7e
commit
81d51b1d1a
@ -60,6 +60,28 @@ void setup()
|
||||
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()
|
||||
{
|
||||
static uint32_t last_msg_ms;
|
||||
|
Loading…
Reference in New Issue
Block a user