gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-07-12 09:47:54 +00:00
Code Issues Projects Releases Wiki Activity

Cleanup

Browse Source
This commit is contained in:
Goebish 2020-06-06 02:13:22 +02:00
parent 369cdcf133
commit 529177f8c2
1 changed files with 2 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
Multiprotocol/V2X2_Rx_nrf24l01.ino
View File

@ -70,9 +70,8 @@ static void __attribute__((unused)) V2X2_Rx_build_telemetry_packet()
packet_in[idx++] = 0; // start channel
packet_in[idx++] = 11; // number of channels in packet
const uint8_t aetr_idx[4] = {3, 2, 0, 1};
// convert & pack channels
const uint8_t aetr_idx[4] = { 3, 2, 0, 1 };
for (uint8_t i = 0; i < packet_in[3]; i++) {
uint32_t val = CHANNEL_MIN_100;
if (i < 4) {
@ -80,7 +79,7 @@ static void __attribute__((unused)) V2X2_Rx_build_telemetry_packet()
uint8_t rx_val = packet[aetr_idx[i]];
if (i != 2 && rx_val < 128)
rx_val = 127 - rx_val;
val = CHANNEL_MIN_100 + ((rx_val << 5) / 5);
val += (rx_val << 5) / 5;
val += (rx_val >> 5);
}
else if (((i == 4) && (packet[14] & 0x04)) || // flip