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

Update Q90C_nrf24l01.ino

Browse Source
This commit is contained in:
Pascal Langer 2020-06-15 14:45:49 +02:00
parent 0a5fd72bdc
commit 210fbe3b9e
1 changed files with 2 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
Multiprotocol/Q90C_nrf24l01.ino
View File

@ -77,6 +77,7 @@ static void __attribute__((unused)) Q90C_send_packet()
packet[5] = 0x1e; // R trim 3c-1e-00 packet[5] = 0x1e; // R trim 3c-1e-00
packet[6] = 0x1e; // E trim 00-1e-3c packet[6] = 0x1e; // E trim 00-1e-3c
//packet[7] = 0x1e; // A trim 00-1e-3c //packet[7] = 0x1e; // A trim 00-1e-3c
packet[8] |= 0x02; // Rudder rate 0=min,1,2=max
if(state!=Channel_data[CH5]) if(state!=Channel_data[CH5])
{ {
state=Channel_data[CH5]; state=Channel_data[CH5];
@ -87,6 +88,7 @@ static void __attribute__((unused)) Q90C_send_packet()
else else
packet[8] ^= 0x08; // Horizon packet[8] ^= 0x08; // Horizon
} }
debugln("8=%02X",packet[8]);
packet[10] = packet_count++; packet[10] = packet_count++;
} }
packet[7] = 0x1e; // bind 1e or 2e, normal: A trim 00-1e-3c packet[7] = 0x1e; // bind 1e or 2e, normal: A trim 00-1e-3c
@ -96,12 +98,8 @@ static void __attribute__((unused)) Q90C_send_packet()
{ {
uint8_t sum=0; uint8_t sum=0;
for (uint8_t i = 0; i < Q90C_PACKET_SIZE - 1; i++) for (uint8_t i = 0; i < Q90C_PACKET_SIZE - 1; i++)
{
sum += packet[i]; sum += packet[i];
debug("%02X ", packet[i]);
}
packet[11] = sum ^ crc8; packet[11] = sum ^ crc8;
debugln("%02X",packet[11]);
} }
XN297L_SetFreqOffset(); // Set frequency offset XN297L_SetFreqOffset(); // Set frequency offset