From 7e53778680776deee3b34209a699156e4aacdf01 Mon Sep 17 00:00:00 2001
From: Pascal Langer <planger@mathworks.com>
Date: Mon, 15 Jun 2020 15:23:02 +0200
Subject: [PATCH] Update Q90C_nrf24l01.ino

---
 Multiprotocol/Q90C_nrf24l01.ino | 8 ++++++++
 1 file changed, 8 insertions(+)

diff --git a/Multiprotocol/Q90C_nrf24l01.ino b/Multiprotocol/Q90C_nrf24l01.ino
index 6848f49..f4d984f 100644
--- a/Multiprotocol/Q90C_nrf24l01.ino
+++ b/Multiprotocol/Q90C_nrf24l01.ino
@@ -28,6 +28,8 @@ Multiprotocol is distributed in the hope that it will be useful,
 #define Q90C_RF_NUM_CHANNELS	3
 #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)
 {
 	int32_t val=Channel_data[num];
@@ -88,6 +90,11 @@ static void __attribute__((unused)) Q90C_send_packet()
 			else
 				packet[8] ^= 0x08;							// Horizon
 		}
+		if(Q90C_VTX!=CH6_SW)
+		{
+			Q90C_VTX=CH6_SW;
+			packet[8] ^= 0x20;								// VTX+
+		}
 		debugln("8=%02X",packet[8]);
 		packet[10] = packet_count++;
 	}
@@ -161,6 +168,7 @@ uint16_t initQ90C()
 
 	//features
 	state=Channel_data[CH5];
+	Q90C_VTX=CH6_SW;
 	packet[8]  = 0x00;
 	packet[9]  = 0x00;
 	return Q90C_INITIAL_WAIT;