Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-23 00:05:28 +03:00
Code Issues Wiki Activity

Merge pull request #3661 from iNavFlight/agh_fix_coordinate_display

Browse source 
Fix missing leading zeroes in when formatting coordinates
This commit is contained in:
Konstantin Sharlaimov 2018-07-28 09:43:35 +02:00 • committed by GitHub
commit cf4048d24e
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23
1 changed files with 7 additions and 16 deletions
Download patch file Download diff file Expand all files Collapse all files

23
src/main/io/osd.c
View file

@ -486,37 +486,28 @@ static uint16_t osdConvertRSSI(void)
static void osdFormatCoordinate(char *buff, char sym, int32_t val)
{
// This should be faster than pow(10, x). Make it available this
// via extern rather than _GNU_SOURCE, since it should be more
// portable.
extern float exp10f(float);
// up to 4 for number + 1 for the symbol + null terminator + fill the rest with decimals
const int coordinateMaxLength = osdConfig()->coordinate_digits + 1;
const int coordinateLength = osdConfig()->coordinate_digits + 1;
buff[0] = sym;
int32_t integerPart = val / GPS_DEGREES_DIVIDER;
// Latitude maximum integer width is 3 (-90) while
// longitude maximum integer width is 4 (-180).
int integerDigits = tfp_sprintf(buff + 1, (integerPart == 0 && val < 0) ? "-%d" : "%d", integerPart);
// We can show up to 7 digits in decimalPart. Remove
// some if needed.
// We can show up to 7 digits in decimalPart.
int32_t decimalPart = abs(val % GPS_DEGREES_DIVIDER);
int trim = 7 - MAX(coordinateMaxLength - 1 - integerDigits, 0);
if (trim > 0) {
decimalPart /= (int32_t)exp10f(trim);
}
int decimalDigits = tfp_sprintf(buff + 1 + integerDigits, "%d", decimalPart);
STATIC_ASSERT(GPS_DEGREES_DIVIDER == 1e7, adjust_max_decimal_digits);
int decimalDigits = tfp_sprintf(buff + 1 + integerDigits, "%07d", decimalPart);
// Embbed the decimal separator
buff[1 + integerDigits - 1] += SYM_ZERO_HALF_TRAILING_DOT - '0';
buff[1 + integerDigits] += SYM_ZERO_HALF_LEADING_DOT - '0';
// Fill up to coordinateMaxLength with zeros
// Fill up to coordinateLength with zeros
int total = 1 + integerDigits + decimalDigits;
while(total < coordinateMaxLength) {
while(total < coordinateLength) {
buff[total] = '0';
total++;
}
buff[coordinateMaxLength] = '\0';
buff[coordinateLength] = '\0';
}
// Used twice, make sure it's exactly the same string