From 94f2e597a2537a969504b9676b06cb219d77326f Mon Sep 17 00:00:00 2001
From: Ligen <ligenxxxx@gmail.com>
Date: Tue, 25 Nov 2025 10:48:49 +0800
Subject: [PATCH] disable ardupilot msp vtx set

---
 src/msp_displayport.c | 15 +++++++++++++++
 1 file changed, 15 insertions(+)

diff --git a/src/msp_displayport.c b/src/msp_displayport.c
index f72c841..9cf4afe 100644
--- a/src/msp_displayport.c
+++ b/src/msp_displayport.c
@@ -817,6 +817,11 @@ void msp_cmd_tx() {
             msp_send_cmd_tx(MSP_FC_VARIANT);
         } else if ((fc_lock & FC_VTX_CONFIG_LOCK) == 0) {
             msp_send_cmd_tx(MSP_GET_VTX_CONFIG);
+
+            msp_send_cmd_tx(MSP_STATUS);
+            if (!g_IS_ARMED) {
+                msp_send_cmd_tx(MSP_RC);
+            }
         } else {
             fc_lock |= FC_STARTUP_LOCK;
 
@@ -1052,6 +1057,7 @@ void parse_status() {
         camera_switch(1);
     }
 
+    g_IS_ARMED = (msp_rx_buf[6] & 0x01);
 #if (0)
     g_IS_PARALYZE = (msp_rx_buf[9] & 0x80);
 
@@ -1113,6 +1119,9 @@ void parse_rc() {
     yaw = (msp_rx_buf[5] << 8) | msp_rx_buf[4];
     throttle = (msp_rx_buf[7] << 8) | msp_rx_buf[6];
 
+    if (msp_cmp_fc_variant("ARDU"))
+        pitch = 3000 - pitch;
+
     update_cms_menu(roll, pitch, yaw, throttle);
 }
 
@@ -1314,11 +1323,17 @@ void parse_vtx_params(uint8_t isMSP_V2) {
 }
 
 void parse_vtx_config(void) {
+    if (!msp_cmp_fc_variant("BTFL") && !msp_cmp_fc_variant("EMUF") && !msp_cmp_fc_variant("QUIC") && !msp_cmp_fc_variant("INAV")) {
+        return;
+    }
     fc_lock |= FC_VTX_CONFIG_LOCK;
     parse_vtx_params(0);
 }
 
 void parseMspVtx_V2(void) {
+    if (!msp_cmp_fc_variant("BTFL") && !msp_cmp_fc_variant("EMUF") && !msp_cmp_fc_variant("QUIC") && !msp_cmp_fc_variant("INAV")) {
+        return;
+    }
     if (fc_lock & FC_VTX_CONFIG_LOCK) {
         parse_vtx_params(1);
     }