Improve FlySky telemetry. (#7042)
* Improve FlySky telemetry. * Cosmetics
This commit is contained in:
@@ -80,7 +80,7 @@ enum
|
|||||||
AFHDS2A_ID_S89 = 0x89,
|
AFHDS2A_ID_S89 = 0x89,
|
||||||
AFHDS2A_ID_S8a = 0x8A,
|
AFHDS2A_ID_S8a = 0x8A,
|
||||||
|
|
||||||
AFHDS2A_ID_ALT_FLYSKY = 0xF9, // Altitude 2 bytes signed in m - used in FlySky native TX
|
AFHDS2A_ID_ALT_FLYSKY = 0xF9, // Altitude 2 bytes signed in m - used in FlySky native TX - SIGNED value
|
||||||
AFHDS2A_ID_RX_SNR = 0xFA, // SNR
|
AFHDS2A_ID_RX_SNR = 0xFA, // SNR
|
||||||
AFHDS2A_ID_RX_NOISE = 0xFB, // Noise
|
AFHDS2A_ID_RX_NOISE = 0xFB, // Noise
|
||||||
AFHDS2A_ID_RX_RSSI = 0xFC, // RSSI
|
AFHDS2A_ID_RX_RSSI = 0xFC, // RSSI
|
||||||
@@ -156,7 +156,7 @@ static void processFlySkySensor(const uint8_t * packet, uint8_t type)
|
|||||||
if (id == 0) id = 0x100; // Some part of OpenTX does not like sensor with id and instance 0, remap to 0x100
|
if (id == 0) id = 0x100; // Some part of OpenTX does not like sensor with id and instance 0, remap to 0x100
|
||||||
|
|
||||||
if (id == AFHDS2A_ID_RX_NOISE || id == AFHDS2A_ID_RX_RSSI) {
|
if (id == AFHDS2A_ID_RX_NOISE || id == AFHDS2A_ID_RX_RSSI) {
|
||||||
value = 135 - value;
|
value = -value;
|
||||||
}
|
}
|
||||||
else if (id == AFHDS2A_ID_RX_ERR_RATE) {
|
else if (id == AFHDS2A_ID_RX_ERR_RATE) {
|
||||||
value = 100 - value;
|
value = 100 - value;
|
||||||
@@ -170,7 +170,7 @@ static void processFlySkySensor(const uint8_t * packet, uint8_t type)
|
|||||||
setTelemetryValue(PROTOCOL_TELEMETRY_FLYSKY_IBUS, AFHDS2A_ID_ALT, 0, instance, getALT(value), UNIT_METERS, 2);
|
setTelemetryValue(PROTOCOL_TELEMETRY_FLYSKY_IBUS, AFHDS2A_ID_ALT, 0, instance, getALT(value), UNIT_METERS, 2);
|
||||||
value &= PRESSURE_MASK;
|
value &= PRESSURE_MASK;
|
||||||
}
|
}
|
||||||
else if ((id >= AFHDS2A_ID_ACC_X && id <= AFHDS2A_ID_VERTICAL_SPEED) || id == AFHDS2A_ID_CLIMB_RATE) {
|
else if ((id >= AFHDS2A_ID_ACC_X && id <= AFHDS2A_ID_VERTICAL_SPEED) || id == AFHDS2A_ID_CLIMB_RATE || id == AFHDS2A_ID_ALT_FLYSKY) {
|
||||||
value = (int16_t) value; // Signed value
|
value = (int16_t) value; // Signed value
|
||||||
}
|
}
|
||||||
else if (id == AFHDS2A_ID_GPS_STATUS) {
|
else if (id == AFHDS2A_ID_GPS_STATUS) {
|
||||||
|
|||||||
Reference in New Issue
Block a user