Ajout FishPeper

2026-04-21 12:19:15 +02:00
parent 6744da3f88
commit 0c361a2440
2160 changed files with 589301 additions and 1 deletions
--- a/OpenSky/arch/stm32f1/hal_uart.c
+++ b/OpenSky/arch/stm32f1/hal_uart.c
@@ -0,0 +1,147 @@
+/*
+    Copyright 2017 fishpepper <AT> gmail.com
+
+    This program is free software: you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation, either version 3 of the License, or
+    (at your option) any later version.
+
+    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.
+
+    You should have received a copy of the GNU General Public License
+    along with this program.  If not, see <http:// www.gnu.org/licenses/>.
+
+   author: fishpepper <AT> gmail.com
+*/
+
+#include "hal_uart.h"
+#include "debug.h"
+#include "main.h"
+#include "sbus.h"
+#include "delay.h"
+#include "config.h"
+#include "hal_defines.h"
+#include "stm32f10x_usart.h"
+#include "stm32f10x_gpio.h"
+#include "stm32f10x_rcc.h"
+#include "misc.h"  // this defines stm32 nvic stuff
+#include "uart.h"
+
+#ifdef SBUS_ENABLED
+
+volatile uint8_t hal_uart_tx_pos;
+volatile uint8_t *hal_uart_tx_buffer;
+
+void hal_uart_init(EXTERNAL_MEMORY uint8_t *data_ptr) {
+    hal_uart_init_rcc();
+    hal_uart_init_gpio();
+    hal_uart_init_nvic();
+    hal_uart_init_mode();
+}
+
+void SBUS_USART_IRQHANDLER(void) {
+    if (USART_GetITStatus(SBUS_USART, USART_IT_TXE) != RESET) {
+        // TXE interrupt
+        // finished with sending?
+        if (hal_uart_tx_pos >= SBUS_DATA_LEN) {
+            // no data in fifo -> disable tx int:
+            USART_ITConfig(SBUS_USART, USART_IT_TXE, DISABLE);
+            // debug_put_newline();
+        } else {
+            // else: data to tx
+            // debug_put_hex8(hal_uart_tx_buffer[hal_uart_tx_pos]);
+            USART_SendData(SBUS_USART, hal_uart_tx_buffer[hal_uart_tx_pos++]);
+        }
+    }
+
+#ifdef HUB_TELEMETRY_ON_SBUS_UART
+    if (USART_GetITStatus(SBUS_USART, USART_IT_RXNE) != RESET) {
+        // RXE interrupt
+        uint8_t rx = USART_ReceiveData(SBUS_USART);
+
+        if (uart_rx_callback != 0) {
+            // execute callback
+            uart_rx_callback(rx);
+        }
+    }
+#endif  // HUB_TELEMETRY_ON_SBUS_UART
+}
+
+
+static void hal_uart_init_nvic(void) {
+    // enable interrupts
+    NVIC_InitTypeDef nvic_init;
+
+    // configure the NVIC Preemption Priority Bits
+    NVIC_PriorityGroupConfig(NVIC_PriorityGroup_0);
+
+    // enable the USART interrupt
+    nvic_init.NVIC_IRQChannel = SBUS_USART_IRQn;
+    nvic_init.NVIC_IRQChannelPreemptionPriority = NVIC_PRIO_SBUS;
+    nvic_init.NVIC_IRQChannelSubPriority = 0;
+    nvic_init.NVIC_IRQChannelCmd = ENABLE;
+    NVIC_Init(&nvic_init);
+}
+
+static void hal_uart_init_gpio(void) {
+    GPIO_InitTypeDef gpio_init;
+
+    // Configure USART TX as alternate function push-pull
+    gpio_init.GPIO_Pin   = SBUS_USART_TX_PIN;
+    gpio_init.GPIO_Speed = GPIO_Speed_50MHz;
+    gpio_init.GPIO_Mode  = GPIO_Mode_AF_PP;
+    GPIO_Init(SBUS_USART_GPIO, &gpio_init);
+}
+
+static void hal_uart_init_rcc(void) {
+    // configure clocks for uart:
+    // enable GPIO clock
+    RCC_APBxPeriphClockCmd(SBUS_USART_GPIO_CLK_RCC, SBUS_USART_GPIO_CLK, ENABLE);
+    RCC_APBxPeriphClockCmd(2, RCC_APB2Periph_AFIO, ENABLE);
+
+    // enable USART clock
+    RCC_APBxPeriphClockCmd(SBUS_USART_RCC, SBUS_USART_CLK, ENABLE);
+}
+
+static void hal_uart_init_mode(void) {
+    USART_InitTypeDef uart_init;
+
+    // USART configuration:
+    // 100000bps inverted serial stream, 8 bits, even parity, 2 stop bits
+    // no hw flow control
+    uart_init.USART_BaudRate            = 100000;
+    // THIS IS TRICKY! for parity bit we need to set uart to 9 bit mode !
+    uart_init.USART_WordLength          = USART_WordLength_9b;
+    uart_init.USART_StopBits            = USART_StopBits_2;
+    uart_init.USART_Parity              = USART_Parity_Even;
+    uart_init.USART_HardwareFlowControl = USART_HardwareFlowControl_None;
+    uart_init.USART_Mode                = USART_Mode_Tx;
+
+#ifdef HUB_TELEMETRY_ON_SBUS_UART
+    uart_init.USART_Mode                |= USART_Mode_Rx;
+#endif  // HUB_TELEMETRY_ON_SBUS_UART
+
+    USART_Init(SBUS_USART, &uart_init);
+
+    USART_Cmd(SBUS_USART, ENABLE);
+
+#ifdef HUB_TELEMETRY_ON_SBUS_UART
+    USART_ITConfig(SBUS_USART, USART_IT_RXNE, ENABLE);
+#endif  // HUB_TELEMETRY_ON_SBUS_UART
+}
+
+void hal_uart_start_transmission(uint8_t *buffer, uint8_t len) {
+    // copy data ptr:
+    hal_uart_tx_buffer = buffer;
+
+    // set up counter:
+    hal_uart_tx_pos = 0;
+
+    // enable TXE int
+    USART_ITConfig(SBUS_USART, USART_IT_TXE, ENABLE);
+}
+
+#endif  // SBUS_ENABLED