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

Q90C: Flight Modes

Browse Source
This commit is contained in:
Pascal Langer
2020-06-14 23:22:27 +02:00
parent a5f627a2d6
commit 6e1701ecc5
2 changed files with 21 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

24
Multiprotocol/Q90C_nrf24l01.ino
View File

@@ -43,9 +43,7 @@ static void __attribute__((unused)) Q90C_send_packet()
{
memcpy(packet, rx_tx_addr, 4);
memcpy(&packet[4], hopping_frequency, 3);
packet[7] = 0x1e; // 2e on Saimat 1???
packet[8] = 0x00;
packet[9] = 0x00;
//packet[7] = 0x1e; // 2e on Saimat 1???
packet[10] = 0x4B;
packet[11] = 0x4E;
}
@@ -78,11 +76,20 @@ static void __attribute__((unused)) Q90C_send_packet()
packet[4] = 0x1e; // T trim 00-1e-3c
packet[5] = 0x1e; // R trim 3c-1e-00
packet[6] = 0x1e; // E trim 00-1e-3c
packet[7] = 0x1e; // A trim 00-1e-3c
packet[8] = 0x00; // flags: 3 position flight mode (Angle - Horizon - Acro), VTX Toggle HIGH = next vTX frequency
packet[9] = 0x00;
//packet[7] = 0x1e; // A trim 00-1e-3c
if(state!=Channel_data[CH5])
{
state=Channel_data[CH5];
if(state<CHANNEL_MIN_COMMAND)
packet[8] ^= 0x04; // Angle
else if(state>CHANNEL_MAX_COMMAND)
packet[8] ^= 0x10; // Acro
else
packet[8] ^= 0x08; // Horizon
}
packet[10] = packet_count++;
}
packet[7] = 0x1e; // bind 1e or 2e, normal: A trim 00-1e-3c
// checksum
if(IS_BIND_DONE)
@@ -153,6 +160,11 @@ uint16_t initQ90C()
hopping_frequency_no = 0;
packet_count = 0;
bind_counter=Q90C_BIND_COUNT;
//features
state=Channel_data[CH5];
packet[8] = 0x00;
packet[9] = 0x00;
return Q90C_INITIAL_WAIT;
}