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

Update Q90C_nrf24l01.ino

Browse Source
This commit is contained in:
Pascal Langer 2020-06-15 15:23:02 +02:00
parent 210fbe3b9e
commit 7e53778680
1 changed files with 8 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
Multiprotocol/Q90C_nrf24l01.ino
View File

@ -28,6 +28,8 @@ Multiprotocol is distributed in the hope that it will be useful,
#define Q90C_RF_NUM_CHANNELS 3 #define Q90C_RF_NUM_CHANNELS 3
#define Q90C_ADDRESS_LENGTH 5 #define Q90C_ADDRESS_LENGTH 5
bool Q90C_VTX;
int16_t Q90C_channel(uint8_t num, int16_t in_min,int16_t in_max, int16_t out_min,int16_t out_max) int16_t Q90C_channel(uint8_t num, int16_t in_min,int16_t in_max, int16_t out_min,int16_t out_max)
{ {
int32_t val=Channel_data[num]; int32_t val=Channel_data[num];
@ -88,6 +90,11 @@ static void __attribute__((unused)) Q90C_send_packet()
else else
packet[8] ^= 0x08; // Horizon packet[8] ^= 0x08; // Horizon
} }
if(Q90C_VTX!=CH6_SW)
{
Q90C_VTX=CH6_SW;
packet[8] ^= 0x20; // VTX+
}
debugln("8=%02X",packet[8]); debugln("8=%02X",packet[8]);
packet[10] = packet_count++; packet[10] = packet_count++;
} }
@ -161,6 +168,7 @@ uint16_t initQ90C()
//features //features
state=Channel_data[CH5]; state=Channel_data[CH5];
Q90C_VTX=CH6_SW;
packet[8] = 0x00; packet[8] = 0x00;
packet[9] = 0x00; packet[9] = 0x00;
return Q90C_INITIAL_WAIT; return Q90C_INITIAL_WAIT;