piotr/edgetx-gx12
1
0
Fork 0
Code Issues 2 Pull Requests Actions Packages Projects Releases Wiki Activity

Fixes #2685: D-type altitude fixes (negative values, hi/lo precision vario)

Browse Source
This commit is contained in:
Damjan Adamic
2015-08-09 22:21:46 +02:00
parent 5d8c86923b
commit 192f5a1bd7
3 changed files with 41 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
radio/src/telemetry/frsky_d.cpp
+7 -3
View File
@@ -521,7 +521,7 @@ const FrSkyDSensor frskyDSensors[] = {
{ ACCEL_Z_ID, ZSTR_ACCZ, UNIT_G, 3 },
{ VARIO_ID, ZSTR_VSPD, UNIT_METERS_PER_SECOND, 2 },
{ VFAS_ID, ZSTR_VFAS, UNIT_VOLTS, 2 },
{ BARO_ALT_AP_ID, ZSTR_ALT, UNIT_METERS, 2 },
{ BARO_ALT_AP_ID, ZSTR_ALT, UNIT_METERS, 1 }, // we map hi precision vario into PREC1!
{ VOLTS_AP_ID, ZSTR_VFAS, UNIT_VOLTS, 2 },
{ GPS_SPEED_BP_ID, ZSTR_GSPD, UNIT_KTS, 0 },
{ GPS_COURS_BP_ID, ZSTR_HDG, UNIT_DEGREE, 0 },
@@ -591,9 +591,13 @@ void processHubPacket(uint8_t id, int16_t value)
}
else if (id == BARO_ALT_AP_ID) {
if (lastId == BARO_ALT_BP_ID) {
data += lastValue * 100;
if (data > 9 || frskyData.varioHighPrecision) {
frskyData.varioHighPrecision = true;
data /= 10; // map hi precision vario into low precision. Altitude is stored in 0.1m anyways
}
data = (int16_t)lastValue * 10 + (((int16_t)lastValue < 0) ? -data : data);
unit = UNIT_METERS;
precision = 2;
precision = 1;
}
else {
return;