Merge with latest 2.3
This commit is contained in:
@@ -61,7 +61,8 @@ enum
|
||||
AFHDS2A_ID_GPS_DIST = 0x14, // 2 bytes distance from home m unsigned
|
||||
AFHDS2A_ID_ARMED = 0x15, // 2 bytes
|
||||
AFHDS2A_ID_FLIGHT_MODE = 0x16, // 2 bytes
|
||||
|
||||
AFHDS3_FRM_TEMP = 0x57, //virtual
|
||||
AFHDS3_FRM_EXT_V = 0x58, //virtual
|
||||
AFHDS2A_ID_PRES = 0x41, // Pressure
|
||||
AFHDS2A_ID_ODO1 = 0x7C, // Odometer1
|
||||
AFHDS2A_ID_ODO2 = 0x7D, // Odometer2
|
||||
@@ -79,8 +80,9 @@ enum
|
||||
AFHDS2A_ID_S88 = 0x88,
|
||||
AFHDS2A_ID_S89 = 0x89,
|
||||
AFHDS2A_ID_S8a = 0x8A,
|
||||
|
||||
AFHDS2A_ID_ALT_FLYSKY = 0xF9, // Altitude 2 bytes signed in m - used in FlySky native TX - SIGNED value
|
||||
AFHDS2A_ID_RX_SIG_AFHDS3 = 0xF7, // SIG
|
||||
AFHDS2A_ID_RX_SNR_AFHDS3 = 0xF8, // SNR
|
||||
AFHDS2A_ID_ALT_FLYSKY = 0xF9, // Altitude 2 bytes signed in m - used in FlySky native TX
|
||||
AFHDS2A_ID_RX_SNR = 0xFA, // SNR
|
||||
AFHDS2A_ID_RX_NOISE = 0xFB, // Noise
|
||||
AFHDS2A_ID_RX_RSSI = 0xFC, // RSSI
|
||||
@@ -120,6 +122,8 @@ const FlySkySensor flySkySensors[] = {
|
||||
{AFHDS2A_ID_FLIGHT_MODE, STR_SENSOR_FLIGHT_MODE, UNIT_RAW, 0}, // 2 bytes index
|
||||
{AFHDS2A_ID_PRES, STR_SENSOR_PRES, UNIT_RAW, 2}, // 4 bytes In fact Temperature + Pressure -> Altitude
|
||||
{AFHDS2A_ID_PRES | 0x100, STR_SENSOR_TEMP2, UNIT_CELSIUS, 1}, // 2 bytes Temperature
|
||||
{AFHDS3_FRM_TEMP, ZSTR_TEMP2, UNIT_CELSIUS, 1}, // 2 bytes temperature
|
||||
{AFHDS3_FRM_EXT_V, ZSTR_TXV, UNIT_VOLTS, 2}, // 2 bytes voltage
|
||||
{AFHDS2A_ID_ODO1, STR_SENSOR_ODO1, UNIT_METERS, 2}, // 2 bytes Odometer1 -- some magic with 330 needed
|
||||
{AFHDS2A_ID_ODO2, STR_SENSOR_ODO2, UNIT_METERS, 2}, // 2 bytes Odometer2 -- some magic with 330 needed
|
||||
{AFHDS2A_ID_SPE, STR_SENSOR_ASPD, UNIT_KMH, 2}, // 2 bytes Speed km/h -- some magic with 330 needed
|
||||
@@ -128,7 +132,8 @@ const FlySkySensor flySkySensors[] = {
|
||||
{AFHDS2A_ID_GPS_LON, STR_SENSOR_GPS, UNIT_RAW, 7}, // 4 bytes signed WGS84 in degrees * 1E7
|
||||
{AFHDS2A_ID_GPS_ALT, STR_SENSOR_GPSALT, UNIT_METERS, 2}, // 4 bytes signed GPS alt m*100
|
||||
{AFHDS2A_ID_ALT, STR_SENSOR_ALT, UNIT_METERS, 2}, // 4 bytes signed Alt m*100
|
||||
|
||||
{AFHDS2A_ID_RX_SIG_AFHDS3, ZSTR_RX_QUALITY, UNIT_RAW, 0}, // RX error rate
|
||||
{AFHDS2A_ID_RX_SNR_AFHDS3, ZSTR_RX_SNR, UNIT_DB, 1}, // RX SNR
|
||||
{AFHDS2A_ID_RX_SNR, STR_SENSOR_RX_SNR, UNIT_DB, 0}, // RX SNR
|
||||
{AFHDS2A_ID_RX_NOISE, STR_SENSOR_RX_NOISE, UNIT_DB, 0}, // RX Noise
|
||||
{AFHDS2A_ID_RX_RSSI, STR_SENSOR_RSSI, UNIT_DB, 0}, // RX RSSI (0xfc)
|
||||
@@ -140,7 +145,7 @@ const FlySkySensor flySkySensors[] = {
|
||||
|
||||
int32_t getALT(uint32_t value);
|
||||
|
||||
static void processFlySkySensor(const uint8_t * packet, uint8_t type)
|
||||
void processFlySkySensor(const uint8_t * packet, uint8_t type)
|
||||
{
|
||||
uint8_t buffer[8];
|
||||
uint16_t id = packet[0];
|
||||
@@ -156,13 +161,17 @@ 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 == AFHDS2A_ID_RX_NOISE || id == AFHDS2A_ID_RX_RSSI) {
|
||||
value = -value;
|
||||
value = 135 - value;
|
||||
}
|
||||
else if (id == AFHDS2A_ID_RX_ERR_RATE) {
|
||||
value = 100 - value;
|
||||
telemetryData.rssi.set(value);
|
||||
if (value > 0) telemetryStreaming = TELEMETRY_TIMEOUT10ms;
|
||||
}
|
||||
else if(id == AFHDS2A_ID_RX_SIG_AFHDS3) {
|
||||
telemetryData.rssi.set(value);
|
||||
if(value>0) telemetryStreaming = TELEMETRY_TIMEOUT10ms;
|
||||
}
|
||||
else if (id == AFHDS2A_ID_PRES && value) {
|
||||
// Extract temperature to a new sensor
|
||||
setTelemetryValue(PROTOCOL_TELEMETRY_FLYSKY_IBUS, id | 0x100, 0, instance, ((value >> 19) - 400), UNIT_CELSIUS, 1);
|
||||
@@ -216,7 +225,7 @@ static void processFlySkySensor(const uint8_t * packet, uint8_t type)
|
||||
for (const FlySkySensor * sensor = flySkySensors; sensor->id; sensor++) {
|
||||
if (sensor->id != id) continue;
|
||||
if (sensor->unit == UNIT_CELSIUS) value -= 400; // Temperature sensors have 40 degree offset
|
||||
else if (sensor->unit == UNIT_VOLTS) value = (uint16_t) value; // Voltage types are unsigned 16bit integers
|
||||
else if (sensor->unit == UNIT_VOLTS) value = (int16_t) value; // Voltage types are unsigned 16bit integers
|
||||
setTelemetryValue(PROTOCOL_TELEMETRY_FLYSKY_IBUS, id, 0, instance, value, sensor->unit, sensor->precision);
|
||||
return;
|
||||
}
|
||||
@@ -390,4 +399,4 @@ int32_t getALT(uint32_t value)
|
||||
|
||||
if (neg ^ tempNegative) result = result * -1;
|
||||
return result;
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user