Skip to content

Commit c6e9d61

Browse files
committed
Convert GPS speed to kph
1 parent a60dbe6 commit c6e9d61

File tree

1 file changed

+5
-5
lines changed

1 file changed

+5
-5
lines changed

main.c

Lines changed: 5 additions & 5 deletions
Original file line numberDiff line numberDiff line change
@@ -1753,8 +1753,8 @@ static void logging_timer_handler(void *p_context) {
17531753
// Or we have drifted too far from the last record we must write a full GPS message
17541754
(
17551755
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 ||
17581758
fabs(hgps.latitude) * 10000 - abs(log_message_gps.latitude) > 32767 ||
17591759
fabs(hgps.longitude) * 10000 - abs(log_message_gps.longitude) > 32767
17601760
)
@@ -1764,7 +1764,7 @@ static void logging_timer_handler(void *p_context) {
17641764
log_message_gps.dt = currentTime;
17651765
log_message_gps.satellites = hgps.sats_in_view;
17661766
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;
17681768
log_message_gps.latitude = hgps.latitude * 100000;
17691769
log_message_gps.longitude = hgps.longitude * 100000;
17701770

@@ -1777,7 +1777,7 @@ static void logging_timer_handler(void *p_context) {
17771777
log_message_gps_delta.dt = currentTime - log_message_gps.dt;
17781778
log_message_gps_delta.satellites = hgps.sats_in_view - log_message_gps.satellites;
17791779
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;
17811781
log_message_gps_delta.latitude = (int32_t)(hgps.latitude * 100000) - log_message_gps.latitude;
17821782
log_message_gps_delta.longitude = (int32_t)(hgps.longitude * 100000) - log_message_gps.longitude;
17831783

@@ -1786,7 +1786,7 @@ static void logging_timer_handler(void *p_context) {
17861786
log_message_gps.dt = currentTime;
17871787
log_message_gps.satellites = hgps.sats_in_view;
17881788
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;
17901790
log_message_gps.latitude = hgps.latitude * 100000;
17911791
log_message_gps.longitude = hgps.longitude * 100000;
17921792

0 commit comments

Comments
 (0)