@@ -1753,8 +1753,8 @@ static void logging_timer_handler(void *p_context) {
1753
1753
// Or we have drifted too far from the last record we must write a full GPS message
1754
1754
(
1755
1755
currentTime - log_message_gps .dt > 255 ||
1756
- hgps .altitude * 10 - log_message_gps .altitude > 127 ||
1757
- hgps .speed * 10 - log_message_gps .speed > 127 ||
1756
+ ( int16_t )( hgps .altitude * 10 ) - log_message_gps .altitude > 127 ||
1757
+ ( int16_t )( hgps .speed * 1.825 * 10 ) - log_message_gps .speed > 127 ||
1758
1758
fabs (hgps .latitude ) * 10000 - abs (log_message_gps .latitude ) > 32767 ||
1759
1759
fabs (hgps .longitude ) * 10000 - abs (log_message_gps .longitude ) > 32767
1760
1760
)
@@ -1764,7 +1764,7 @@ static void logging_timer_handler(void *p_context) {
1764
1764
log_message_gps .dt = currentTime ;
1765
1765
log_message_gps .satellites = hgps .sats_in_view ;
1766
1766
log_message_gps .altitude = hgps .altitude * 10 ;
1767
- log_message_gps .speed = hgps .speed * 10 ;
1767
+ log_message_gps .speed = hgps .speed * 1.825 * 10 ;
1768
1768
log_message_gps .latitude = hgps .latitude * 100000 ;
1769
1769
log_message_gps .longitude = hgps .longitude * 100000 ;
1770
1770
@@ -1777,7 +1777,7 @@ static void logging_timer_handler(void *p_context) {
1777
1777
log_message_gps_delta .dt = currentTime - log_message_gps .dt ;
1778
1778
log_message_gps_delta .satellites = hgps .sats_in_view - log_message_gps .satellites ;
1779
1779
log_message_gps_delta .altitude = (int16_t )(hgps .altitude * 10 ) - log_message_gps .altitude ;
1780
- log_message_gps_delta .speed = (int16_t )(hgps .speed * 10 ) - log_message_gps .speed ;
1780
+ log_message_gps_delta .speed = (int16_t )(hgps .speed * 1.825 * 10 ) - log_message_gps .speed ;
1781
1781
log_message_gps_delta .latitude = (int32_t )(hgps .latitude * 100000 ) - log_message_gps .latitude ;
1782
1782
log_message_gps_delta .longitude = (int32_t )(hgps .longitude * 100000 ) - log_message_gps .longitude ;
1783
1783
@@ -1786,7 +1786,7 @@ static void logging_timer_handler(void *p_context) {
1786
1786
log_message_gps .dt = currentTime ;
1787
1787
log_message_gps .satellites = hgps .sats_in_view ;
1788
1788
log_message_gps .altitude = hgps .altitude * 10 ;
1789
- log_message_gps .speed = hgps .speed * 10 ;
1789
+ log_message_gps .speed = hgps .speed * 1.825 * 10 ;
1790
1790
log_message_gps .latitude = hgps .latitude * 100000 ;
1791
1791
log_message_gps .longitude = hgps .longitude * 100000 ;
1792
1792
0 commit comments