Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-16 21:05:35 +03:00
Code Issues Wiki Activity

Update HoTT GPS coordinate calculations.

Browse source 
It was broken for South/West values.

Added additional tests for maximum long/lat values.

Requires field testing to make sure values are correct on the telemetry
display.
This commit is contained in:
Dominic Clifton 2014-05-26 02:15:06 +01:00
parent 37051720fd
commit 8f6558156f
2 changed files with 63 additions and 19 deletions
Download patch file Download diff file Expand all files Collapse all files

20
src/telemetry_hott.c
View file

@ -121,11 +121,11 @@ static void initialiseMessages(void)
void addGPSCoordinates(HOTT_GPS_MSG_t *hottGPSMessage, int32_t latitude, int32_t longitude)
{
uint8_t deg = latitude / 10000000UL;
uint32_t sec = (latitude - (deg * 10000000UL)) * 6;
uint8_t min = sec / 1000000UL;
sec = (sec % 1000000UL) / 100UL;
uint16_t degMin = (deg * 100) + min;
int16_t deg = latitude / 10000000L;
int32_t sec = (latitude - (deg * 10000000L)) * 6;
int8_t min = sec / 1000000L;
sec = (sec % 1000000L) / 100L;
uint16_t degMin = (deg * 100L) + min;
hottGPSMessage->pos_NS = (latitude < 0);
hottGPSMessage->pos_NS_dm_L = degMin;
@ -133,11 +133,11 @@ void addGPSCoordinates(HOTT_GPS_MSG_t *hottGPSMessage, int32_t latitude, int32_t
hottGPSMessage->pos_NS_sec_L = sec;
hottGPSMessage->pos_NS_sec_H = sec >> 8;
deg = longitude / 10000000UL;
sec = (longitude - (deg * 10000000UL)) * 6;
min = sec / 1000000UL;
sec = (sec % 1000000UL) / 100UL;
degMin = (deg * 100) + min;
deg = longitude / 10000000L;
sec = (longitude - (deg * 10000000L)) * 6;
min = sec / 1000000L;
sec = (sec % 1000000L) / 100L;
degMin = (deg * 100L) + min;
hottGPSMessage->pos_EW = (longitude < 0);
hottGPSMessage->pos_EW_dm_L = degMin;