@@ -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
- fabs ( hgps .altitude ) * 10 - log_message_gps .altitude > 127 ||
1757
- fabs ( hgps .speed ) * 10 - log_message_gps .speed > 127 ||
1756
+ hgps .altitude * 10 - log_message_gps .altitude > 127 ||
1757
+ hgps .speed * 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
)
@@ -1763,8 +1763,8 @@ static void logging_timer_handler(void *p_context) {
1763
1763
//TODO: duplicated code
1764
1764
log_message_gps .dt = currentTime ;
1765
1765
log_message_gps .satellites = hgps .sats_in_view ;
1766
- log_message_gps .altitude = fabs ( hgps .altitude ) * 10 ;
1767
- log_message_gps .speed = fabs ( hgps .speed ) * 10 ;
1766
+ log_message_gps .altitude = hgps .altitude * 10 ;
1767
+ log_message_gps .speed = hgps .speed * 10 ;
1768
1768
log_message_gps .latitude = hgps .latitude * 100000 ;
1769
1769
log_message_gps .longitude = hgps .longitude * 100000 ;
1770
1770
@@ -1776,17 +1776,17 @@ static void logging_timer_handler(void *p_context) {
1776
1776
// Update delta message
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
- log_message_gps_delta .altitude = fabs ( hgps .altitude ) * 10 - log_message_gps .altitude ;
1780
- log_message_gps_delta .speed = fabs ( hgps .speed ) * 10 - log_message_gps .speed ;
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 ;
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
1784
1784
// Update full message
1785
1785
//TODO: duplicated code
1786
1786
log_message_gps .dt = currentTime ;
1787
1787
log_message_gps .satellites = hgps .sats_in_view ;
1788
- log_message_gps .altitude = fabs ( hgps .altitude ) * 10 ;
1789
- log_message_gps .speed = fabs ( hgps .speed ) * 10 ;
1788
+ log_message_gps .altitude = hgps .altitude * 10 ;
1789
+ log_message_gps .speed = hgps .speed * 10 ;
1790
1790
log_message_gps .latitude = hgps .latitude * 100000 ;
1791
1791
log_message_gps .longitude = hgps .longitude * 100000 ;
1792
1792
0 commit comments