rusefi
/
atbetaflight
mirror of https://github.com/rusefi/atbetaflight.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Merge pull request #743 from SamuelBrucksch/master 

Fixed speed according to frsky protocol
This commit is contained in:
Dominic Clifton 2015-04-14 20:17:59 +01:00
parent 21191c0e14 c8a33ab1db
commit 0ecf8be233
1 changed files with 4 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/main/telemetry/frsky.c
View File

@ -242,11 +242,12 @@ static void sendSpeed(void)
if (!STATE(GPS_FIX)) {
return;
}
//Speed should be sent in m/s (GPS speed is in cm/s)
//Speed should be sent in knots (GPS speed is in cm/s)
sendDataHead(ID_GPS_SPEED_BP);
serialize16((GPS_speed * 0.01 + 0.5));
//convert to knots: 1cm/s = 0.0194384449 knots
serialize16(GPS_speed * 1944 / 10000);
sendDataHead(ID_GPS_SPEED_AP);
serialize16(0); //Not dipslayed
serialize16((GPS_speed * 1944 / 100) % 100);
}
#endif