From 1296169091749f5c8ee0b5b5ca1de94bb07aa3de Mon Sep 17 00:00:00 2001 From: hori64 Date: Tue, 24 May 2016 17:54:29 +0200 Subject: [PATCH] Smart Port telemetry GPS ground speed unit is not applicable. (#2166) Second try --- src/main/telemetry/smartport.c | 6 ++++-- 1 file changed, 4 insertions(+), 2 deletions(-) diff --git a/src/main/telemetry/smartport.c b/src/main/telemetry/smartport.c index c9be67089..0076b3542 100644 --- a/src/main/telemetry/smartport.c +++ b/src/main/telemetry/smartport.c @@ -628,8 +628,10 @@ void handleSmartPortTelemetry(void) #ifdef GPS case FSSP_DATAID_SPEED : if (sensors(SENSOR_GPS) && STATE(GPS_FIX)) { - uint32_t tmpui = (GPS_speed * 36 + 36 / 2) / 100; - smartPortSendPackage(id, tmpui); // given in 0.1 m/s, provide in KM/H + //convert to knots: 1cm/s = 0.0194384449 knots + //Speed should be sent in knots/1000 (GPS speed is in cm/s) + uint32_t tmpui = GPS_speed * 1944 / 100; + smartPortSendPackage(id, tmpui); smartPortHasRequest = 0; } break;