From 31b819c83b437041da01d6fb8ac69a5870793831 Mon Sep 17 00:00:00 2001
From: Richard Li <richard.li@ces.hk>
Date: Thu, 22 Jul 2021 12:44:26 +0800
Subject: [PATCH] Try to fix external module.

---
 radio/src/targets/nv14/extmodule_helper.cpp | 63 +++++++++++++++++++++
 radio/src/targets/nv14/telemetry_driver.cpp |  4 +-
 2 files changed, 65 insertions(+), 2 deletions(-)
 create mode 100644 radio/src/targets/nv14/extmodule_helper.cpp

diff --git a/radio/src/targets/nv14/extmodule_helper.cpp b/radio/src/targets/nv14/extmodule_helper.cpp
new file mode 100644
index 000000000..49c2d7d0d
--- /dev/null
+++ b/radio/src/targets/nv14/extmodule_helper.cpp
@@ -0,0 +1,63 @@
+/*
+ * Copyright (C) OpenTX
+ *
+ * Based on code named
+ *   th9x - http://code.google.com/p/th9x
+ *   er9x - http://code.google.com/p/er9x
+ *   gruvin9x - http://code.google.com/p/gruvin9x
+ *
+ * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include "opentx.h"
+
+void EXTERNAL_MODULE_ON()
+{
+  GPIO_SetBits(EXTMODULE_PWR_GPIO, EXTMODULE_PWR_GPIO_PIN);
+  GPIO_ResetBits(EXTMODULE_PWR_FIX_GPIO, EXTMODULE_PWR_FIX_GPIO_PIN);
+}
+
+void EXTERNAL_MODULE_OFF()
+{
+  GPIO_ResetBits(EXTMODULE_PWR_GPIO, EXTMODULE_PWR_GPIO_PIN);
+  GPIO_SetBits(EXTMODULE_PWR_FIX_GPIO, EXTMODULE_PWR_FIX_GPIO_PIN);
+}
+
+void extModuleInit()
+{
+  GPIO_InitTypeDef GPIO_InitStructure;
+  GPIO_InitStructure.GPIO_Pin = EXTMODULE_PWR_GPIO_PIN;
+  GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
+  GPIO_InitStructure.GPIO_Speed = GPIO_Speed_2MHz;
+  GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
+  GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
+  GPIO_ResetBits(EXTMODULE_PWR_GPIO, EXTMODULE_PWR_GPIO_PIN);
+  GPIO_Init(EXTMODULE_PWR_GPIO, &GPIO_InitStructure);
+
+  //for additional transistor to ensuring module is completely disabled
+  GPIO_InitStructure.GPIO_OType = GPIO_OType_OD;
+  //pin must be pulled to V+ (voltage of board - VCC is not enough to fully close transistor)
+  GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;
+  GPIO_InitStructure.GPIO_Pin = EXTMODULE_PWR_FIX_GPIO_PIN;
+  GPIO_SetBits(EXTMODULE_PWR_FIX_GPIO, EXTMODULE_PWR_FIX_GPIO_PIN);
+  GPIO_Init(EXTMODULE_PWR_FIX_GPIO, &GPIO_InitStructure);
+
+  GPIO_InitStructure.GPIO_Pin = EXTMODULE_TX_INVERT_GPIO_PIN;
+  GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
+  GPIO_Init(EXTMODULE_TX_INVERT_GPIO, &GPIO_InitStructure);
+
+  GPIO_InitStructure.GPIO_Pin = EXTMODULE_RX_INVERT_GPIO_PIN;
+  GPIO_Init(EXTMODULE_RX_INVERT_GPIO, &GPIO_InitStructure);
+
+  GPIO_ResetBits(EXTMODULE_TX_INVERT_GPIO, EXTMODULE_TX_INVERT_GPIO_PIN);
+  GPIO_ResetBits(EXTMODULE_RX_INVERT_GPIO, EXTMODULE_RX_INVERT_GPIO_PIN);
+}
diff --git a/radio/src/targets/nv14/telemetry_driver.cpp b/radio/src/targets/nv14/telemetry_driver.cpp
index 2e440380c..b8cce7e8b 100644
--- a/radio/src/targets/nv14/telemetry_driver.cpp
+++ b/radio/src/targets/nv14/telemetry_driver.cpp
@@ -94,10 +94,10 @@ void telemetryPortInvertedInit(uint32_t baudrate)
 #warning "TODO telemetryPortInvertedInit";
 }
 
-void extmoduleSendInvertedByte(uint8_t byte)
+/*void extmoduleSendInvertedByte(uint8_t byte)
 {
 #warning "TODO extmoduleSendInvertedByte";
-}
+}*/
 
 void telemetryPortSetDirectionOutput()
 {