From d366af00c6843cf66e3130c49ef4fff14d948159 Mon Sep 17 00:00:00 2001 From: Martin Budden Date: Fri, 8 Jul 2016 10:29:16 +0100 Subject: [PATCH] Fixed GPS speed --- src/main/telemetry/hott.c | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/src/main/telemetry/hott.c b/src/main/telemetry/hott.c index 6fb0bc1a92..7ccf8ea197 100644 --- a/src/main/telemetry/hott.c +++ b/src/main/telemetry/hott.c @@ -193,15 +193,15 @@ void hottPrepareGPSResponse(HOTT_GPS_MSG_t *hottGPSMessage) addGPSCoordinates(hottGPSMessage, GPS_coord[LAT], GPS_coord[LON]); - // GPS Speed in km/h - uint16_t speed = (GPS_speed * 36) / 100; // 0->1m/s * 0->36 = km/h + // GPS Speed is returned in cm/s (from io/gps.c) and must be sent in km/h (Hott requirement) + const uint16_t speed = (GPS_speed * 36) / 1000; hottGPSMessage->gps_speed_L = speed & 0x00FF; hottGPSMessage->gps_speed_H = speed >> 8; hottGPSMessage->home_distance_L = GPS_distanceToHome & 0x00FF; hottGPSMessage->home_distance_H = GPS_distanceToHome >> 8; - uint16_t hottGpsAltitude = (GPS_altitude) + HOTT_GPS_ALTITUDE_OFFSET; // GPS_altitude in m ; offset = 500 -> O m + const uint16_t hottGpsAltitude = (GPS_altitude) + HOTT_GPS_ALTITUDE_OFFSET; // GPS_altitude in m ; offset = 500 -> O m hottGPSMessage->altitude_L = hottGpsAltitude & 0x00FF; hottGPSMessage->altitude_H = hottGpsAltitude >> 8;