DEVO: temp telem fix

This commit is contained in:
Pascal Langer 2021-03-02 16:30:14 +01:00
parent 99ca6fa36c
commit ca9e2870ab

View File

@ -244,10 +244,13 @@ static void __attribute__((unused)) DEVO_parse_telemetry_packet()
break; break;
case 0x31: // Temperature packet case 0x31: // Temperature packet
//memcpy(&packet[1],"\x29\x2A\x2B\x00\x00\x00\x00\x00\x00\x00\x00\x00",12); // 21°, 22°, 23° //memcpy(&packet[1],"\x29\x2A\x2B\x00\x00\x00\x00\x00\x00\x00\x00\x00",12); // 21°, 22°, 23°
if(packet[1]!=0xff) for(uint8_t i=0; i<2;i++)
frsky_send_user_frame(0x02, packet[1]-20, 0x00); // temp1 if(packet[i+1]!=0xff)
if(packet[2]!=0xff) {
frsky_send_user_frame(0x05, packet[2]-20, 0x00); // temp2 val = packet[i+1];
val -= 20;
frsky_send_user_frame(0x02 + i*3, val, val>>8); // temp 1 & 2
}
break; break;
// GPS Data // GPS Data
case 0x32: // Longitude case 0x32: // Longitude