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

Update Devo_cyrf6936.ino

Browse Source
This commit is contained in:
Pascal Langer 2021-03-01 14:02:39 +01:00
parent 6bb2c06cf6
commit ac71b4d981
1 changed files with 53 additions and 47 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
Multiprotocol/Devo_cyrf6936.ino
View File

@ -192,8 +192,6 @@ static void __attribute__((unused)) DEVO_float_to_ints(uint8_t *ptr, uint16_t *v
}
}
extern void frsky_send_user_frame(uint8_t, uint8_t, uint8_t);
static void __attribute__((unused)) DEVO_parse_telemetry_packet()
{
DEVO_scramble_pkt(); //This will unscramble the packet
@ -211,6 +209,7 @@ 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
uint16_t val, dec;
switch(packet[0])
{
@ -258,6 +257,13 @@ static void __attribute__((unused)) DEVO_parse_telemetry_packet()
frsky_send_user_frame(0x18, DEVO_text_to_int(&packet[5], 2), 0x00); // second
break;
}
#else
if(packet[0] == 0x30)
{
v_lipo1 = packet[1] << 1;
v_lipo2 = packet[3] << 1;
}
#endif
}
#endif