From 65c154406872a124b844311a1fd65ffc2da5e0b4 Mon Sep 17 00:00:00 2001 From: Richard Li Date: Sun, 15 Aug 2021 11:41:07 +0800 Subject: [PATCH] Fixed telemetry for NV14 external module. --- radio/src/targets/nv14/telemetry_driver.cpp | 9 +++++++-- 1 file changed, 7 insertions(+), 2 deletions(-) diff --git a/radio/src/targets/nv14/telemetry_driver.cpp b/radio/src/targets/nv14/telemetry_driver.cpp index adf82c752..db356b5c7 100644 --- a/radio/src/targets/nv14/telemetry_driver.cpp +++ b/radio/src/targets/nv14/telemetry_driver.cpp @@ -65,8 +65,11 @@ void telemetryPortInit(uint32_t baudrate, uint8_t mode) GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT; GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL; GPIO_Init(TELEMETRY_REV_GPIO, &GPIO_InitStructure); - TELEMETRY_TX_POL_INV(); - TELEMETRY_RX_POL_INV(); +// TELEMETRY_TX_POL_INV(); +// TELEMETRY_RX_POL_INV(); + + TELEMETRY_TX_POL_NORM(); + TELEMETRY_RX_POL_NORM(); USART_InitStructure.USART_BaudRate = baudrate; if (mode & TELEMETRY_SERIAL_8E2) { @@ -113,6 +116,8 @@ void telemetryPortSetDirectionInput() void sportSendByte(uint8_t byte) { + telemetryPortSetDirectionOutput(); + while (!(TELEMETRY_USART->SR & USART_SR_TXE)); USART_SendData(TELEMETRY_USART, byte); }