From c231efcb7a04e93ab1bb2fb46d8235af365c5010 Mon Sep 17 00:00:00 2001
From: 3djc <lesitewebdejc@hotmail.com>
Date: Tue, 13 Aug 2024 03:22:27 +0200
Subject: [PATCH] fix(tx16s): turn on AUX2 power when used for BT (#5353)

---
 radio/src/bluetooth.cpp                                 | 9 +++++++++
 radio/src/targets/common/arm/stm32/bluetooth_driver.cpp | 9 +++++++++
 radio/src/targets/horus/hal.h                           | 3 +++
 3 files changed, 21 insertions(+)

diff --git a/radio/src/bluetooth.cpp b/radio/src/bluetooth.cpp
index d126f580b..80da794de 100644
--- a/radio/src/bluetooth.cpp
+++ b/radio/src/bluetooth.cpp
@@ -413,6 +413,15 @@ void Bluetooth::wakeup()
     return;
   }
 
+#if defined(BT_PWR_GPIO)
+  if (g_eeGeneral.bluetoothMode == BLUETOOTH_OFF) {
+    bluetoothDisable();
+    state = BLUETOOTH_STATE_OFF;
+    wakeupTime = now + 10; /* 100ms */
+    return;
+  }
+#endif
+
   if (g_eeGeneral.bluetoothMode == BLUETOOTH_OFF ||
       (g_eeGeneral.bluetoothMode == BLUETOOTH_TRAINER &&
        !IS_BLUETOOTH_TRAINER())) {
diff --git a/radio/src/targets/common/arm/stm32/bluetooth_driver.cpp b/radio/src/targets/common/arm/stm32/bluetooth_driver.cpp
index 605765aa2..f43a74929 100644
--- a/radio/src/targets/common/arm/stm32/bluetooth_driver.cpp
+++ b/radio/src/targets/common/arm/stm32/bluetooth_driver.cpp
@@ -63,6 +63,9 @@ void bluetoothInit(uint32_t baudrate, bool enable)
 #if defined(BT_EN_GPIO)
   gpio_init(BT_EN_GPIO, GPIO_OUT, GPIO_PIN_SPEED_LOW);
 #endif
+#if defined(BT_PWR_GPIO)
+  gpio_init(BT_PWR_GPIO, GPIO_OUT, GPIO_PIN_SPEED_LOW);
+#endif
 
 #if !defined(BOOT)
   etx_serial_init cfg = {
@@ -83,6 +86,9 @@ void bluetoothInit(uint32_t baudrate, bool enable)
 #if defined(BT_EN_GPIO)
   gpio_write(BT_EN_GPIO, !enable);
 #endif
+#if defined(BT_PWR_GPIO)
+  gpio_set(BT_PWR_GPIO);
+#endif
 }
 
 #if !defined(BOOT)
@@ -91,6 +97,9 @@ void bluetoothDisable()
 #if defined(BT_EN_GPIO)
   // close bluetooth (recent modules will go to bootloader mode)
   gpio_set(BT_EN_GPIO);
+#endif
+#if defined(BT_PWR_GPIO)
+  gpio_clear(BT_PWR_GPIO);
 #endif
   if (_bt_usart_ctx) {
     STM32SerialDriver.deinit(_bt_usart_ctx);
diff --git a/radio/src/targets/horus/hal.h b/radio/src/targets/horus/hal.h
index d81b1490d..2326cb157 100644
--- a/radio/src/targets/horus/hal.h
+++ b/radio/src/targets/horus/hal.h
@@ -1057,6 +1057,9 @@
   #define BT_USART_GPIO                 GPIOG
   #define BT_TX_GPIO                    GPIO_PIN(GPIOG, 14) // PG.14
   #define BT_RX_GPIO                    GPIO_PIN(GPIOG, 9)  // PG.09
+#if defined(RADIO_TX16S)
+  #define BT_PWR_GPIO                   GPIO_PIN(GPIOB, 0) // PB.00
+#endif
 #endif
 
 #if defined(PCBX12S)