gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-02-04 18:58:13 +00:00
Code Issues Projects Releases Wiki Activity

Devo: added telemetry voltage 3

Browse Source
This commit is contained in:
Pascal Langer 2021-03-02 09:32:59 +01:00
parent 9ba56f040a
commit b3132c7bf1
1 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
Multiprotocol/Devo_cyrf6936.ino
View File

@ -208,14 +208,17 @@ static void __attribute__((unused)) DEVO_parse_telemetry_packet()
debug("P[0]=%02X",packet[0]);
//Telemetry https://github.com/DeviationTX/deviation/blob/5efb6a28bea697af9a61b5a0ed2528cc8d203f90/src/protocol/devo_cyrf6936.c#L232
#if defined HUB_TELEMETRY
//Telemetry https://github.com/DeviationTX/deviation/blob/5efb6a28bea697af9a61b5a0ed2528cc8d203f90/src/protocol/devo_cyrf6936.c#L232
uint16_t val, dec;
switch(packet[0])
{
case 0x30: // Volt and RPM packet
v_lipo1 = packet[1] << 1;
v_lipo2 = packet[3] << 1;
val = packet[5]/10;
frsky_send_user_frame(0x3A, val, 0x00); // volt3
frsky_send_user_frame(0x3B, packet[5] - val*10, 0x00); // volt3
val = packet[7] * 120; //In RPM
frsky_send_user_frame(0x03, val, val>>8); // RPM
break;