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

Report unknown Spectrum sensors as raw sensors (#3679)

Browse Source
This commit is contained in:
Arne Schwabe
2016-08-03 05:11:43 +02:00
committed by Bertrand Songis
parent 7fbd963b3f
commit 789a0ee548
1 changed files with 12 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
radio/src/telemetry/spektrum.cpp
+12
View File
@@ -262,8 +262,10 @@ void processSpektrumPacket(uint8_t *packet) {
uint8_t i2cAddress = (packet[2] & 0x7f);
uint8_t instance = packet[3];
bool handled = false;
for (const SpektrumSensor *sensor = spektrumSensors; sensor->i2caddress; sensor++) {
if (i2cAddress == sensor->i2caddress) {
handled = true;
// Extract value, skip header
int32_t value = spektrumGetValue(packet + 4, sensor->startByte, sensor->dataType);
@@ -308,6 +310,16 @@ void processSpektrumPacket(uint8_t *packet) {
setTelemetryValue(TELEM_PROTO_SPEKTRUM, pseudoId, 0, instance, value, sensor->unit, sensor->precision);
}
}
if (!handled) {
// If we see a sensor that is not handled at all, add the raw values of this sensor to show its existance to
// the user and help debugging/implementing these sensors
for (int startByte=0;startByte <14; startByte+=2) {
int32_t value = spektrumGetValue(packet + 4, startByte, uint16);
uint16_t pseudoId = i2cAddress << 8 | startByte;
setTelemetryValue(TELEM_PROTO_SPEKTRUM, pseudoId, 0, instance, value, UNIT_RAW, 0);
}
}
}
void processSpektrumTelemetryData(uint8_t data) {