37#include "mcu_periph/uart_arch.h"
46#ifndef UART_THREAD_STACK_SIZE
47#define UART_THREAD_STACK_SIZE 512
60#define SERIAL_INIT_NULL { NULL, NULL, NULL, NULL, NULL, 0, 0 }
68 uint8_t c = sdGet((SerialDriver *)(
p->reg_addr));
70 struct SerialInit *init_struct = (
struct SerialInit *)(
p->init_struct);
71 chMtxLock(init_struct->rx_mtx);
74 p->rx_buf[
p->rx_insert_idx] = c;
76 if (temp !=
p->rx_extract_idx) {
77 p->rx_insert_idx = temp;
79 chMtxUnlock(init_struct->rx_mtx);
80 chSemSignal(init_struct->rx_sem);
90 struct SerialInit *init_struct = (
struct SerialInit *)(
p->init_struct);
91 chSemWait(init_struct->tx_sem);
93 while (
p->tx_insert_idx !=
p->tx_extract_idx) {
94#if USE_UART_SOFT_FLOW_CONTROL
95 if (init_struct->cts_port != 0) {
97 while (
gpio_get(init_struct->cts_port, init_struct->cts_pin) == 1) ;
99 uint8_t data =
p->tx_buf[
p->tx_extract_idx];
100 sdPut((SerialDriver *)
p->reg_addr, data);
101 chMtxLock(init_struct->tx_mtx);
104 chMtxUnlock(init_struct->tx_mtx);
105 if (init_struct->cts_port != 0) {
107 while ((((SerialDriver *)
p->reg_addr)->usart->SR & USART_SR_TC) == 0) ;
110 chMtxLock(init_struct->tx_mtx);
111 if (
p->tx_insert_idx >
p->tx_extract_idx) {
112 sdWrite((SerialDriver *)
p->reg_addr, &
p->tx_buf[
p->tx_extract_idx],
p->tx_insert_idx -
p->tx_extract_idx);
116 if(
p->tx_insert_idx > 0) {
117 sdWrite((SerialDriver *)
p->reg_addr, &
p->tx_buf[0],
p->tx_insert_idx);
120 p->tx_extract_idx =
p->tx_insert_idx;
121 chMtxUnlock(init_struct->tx_mtx);
124 p->tx_running =
false;
130#define UART1_BAUD SERIAL_DEFAULT_BITRATE
135#define USE_UART1_TX TRUE
138#define USE_UART1_RX TRUE
146#define UART1_CR2 USART_CR2_STOP1_BITS
153static SerialConfig usart1_config = {
160static struct SerialInit uart1_init_struct = SERIAL_INIT_NULL;
167static __attribute__((noreturn))
void thd_uart1_rx(
void *arg)
170 chRegSetThreadName(
"uart1_rx");
173 handle_uart_rx(&uart1);
184static __attribute__((noreturn))
void thd_uart1_tx(
void *arg)
187 chRegSetThreadName(
"uart1_tx");
190 handle_uart_tx(&uart1);
201#if USE_UART1_TX && defined UART1_GPIO_PORT_TX
204#if USE_UART1_RX && defined UART1_GPIO_PORT_RX
208 sdStart(&SD1, &usart1_config);
209 uart1.reg_addr = &SD1;
210 uart1.baudrate = UART1_BAUD;
211 uart1.init_struct = &uart1_init_struct;
212 uart1_init_struct.conf = &usart1_config;
216 uart1_init_struct.rx_mtx = &uart1_rx_mtx;
217 uart1_init_struct.rx_sem = &uart1_rx_sem;
218 chThdCreateStatic(wa_thd_uart1_rx,
sizeof(wa_thd_uart1_rx),
219 NORMALPRIO + 1, thd_uart1_rx, NULL);
222 uart1_init_struct.tx_mtx = &uart1_tx_mtx;
223 uart1_init_struct.tx_sem = &uart1_tx_sem;
224 chThdCreateStatic(wa_thd_uart1_tx,
sizeof(wa_thd_uart1_tx),
225 NORMALPRIO + 1, thd_uart1_tx, NULL);
235#define UART2_BAUD SERIAL_DEFAULT_BITRATE
240#define USE_UART2_TX TRUE
243#define USE_UART2_RX TRUE
248#ifndef UART2_HW_FLOW_CONTROL
249#define UART2_HW_FLOW_CONTROL FALSE
252#if UART2_HW_FLOW_CONTROL && defined(UART2_CR3)
253#warning "UART2_CR3 reset to your value, HW flow control not enabled! You may want to set USART_CR3_CTSE | USART_CR3_RTSE yourself."
261#define UART2_CR2 USART_CR2_STOP1_BITS
265#if UART2_HW_FLOW_CONTROL
266#define UART2_CR3 USART_CR3_CTSE | USART_CR3_RTSE
272static SerialConfig usart2_config = {
279static struct SerialInit uart2_init_struct = SERIAL_INIT_NULL;
286static __attribute__((noreturn))
void thd_uart2_rx(
void *arg)
289 chRegSetThreadName(
"uart2_rx");
292 handle_uart_rx(&uart2);
303static __attribute__((noreturn))
void thd_uart2_tx(
void *arg)
306 chRegSetThreadName(
"uart2_tx");
309 handle_uart_tx(&uart2);
320#if USE_UART2_TX && defined UART2_GPIO_PORT_TX
323#if USE_UART2_RX && defined UART2_GPIO_PORT_RX
327 sdStart(&SD2, &usart2_config);
328 uart2.reg_addr = &SD2;
329 uart2.baudrate = UART2_BAUD;
330 uart2.init_struct = &uart2_init_struct;
331 uart2_init_struct.conf = &usart2_config;
335 uart2_init_struct.rx_mtx = &uart2_rx_mtx;
336 uart2_init_struct.rx_sem = &uart2_rx_sem;
337 chThdCreateStatic(wa_thd_uart2_rx,
sizeof(wa_thd_uart2_rx),
338 NORMALPRIO + 1, thd_uart2_rx, NULL);
341 uart2_init_struct.tx_mtx = &uart2_tx_mtx;
342 uart2_init_struct.tx_sem = &uart2_tx_sem;
343 chThdCreateStatic(wa_thd_uart2_tx,
sizeof(wa_thd_uart2_tx),
344 NORMALPRIO + 1, thd_uart2_tx, NULL);
353#define UART3_BAUD SERIAL_DEFAULT_BITRATE
358#define USE_UART3_TX TRUE
361#define USE_UART3_RX TRUE
369#define UART3_CR2 USART_CR2_STOP1_BITS
376static SerialConfig usart3_config = {
383static struct SerialInit uart3_init_struct = SERIAL_INIT_NULL;
390static __attribute__((noreturn))
void thd_uart3_rx(
void *arg)
393 chRegSetThreadName(
"uart3_rx");
396 handle_uart_rx(&uart3);
407static __attribute__((noreturn))
void thd_uart3_tx(
void *arg)
410 chRegSetThreadName(
"uart3_tx");
413 handle_uart_tx(&uart3);
424#if USE_UART3_TX && defined UART3_GPIO_PORT_TX
427#if USE_UART3_RX && defined UART3_GPIO_PORT_RX
431 sdStart(&SD3, &usart3_config);
432 uart3.reg_addr = &SD3;
433 uart3.baudrate = UART3_BAUD;
434 uart3.init_struct = &uart3_init_struct;
435 uart3_init_struct.conf = &usart3_config;
439 uart3_init_struct.rx_mtx = &uart3_rx_mtx;
440 uart3_init_struct.rx_sem = &uart3_rx_sem;
441 chThdCreateStatic(wa_thd_uart3_rx,
sizeof(wa_thd_uart3_rx),
442 NORMALPRIO + 1, thd_uart3_rx, NULL);
445 uart3_init_struct.tx_mtx = &uart3_tx_mtx;
446 uart3_init_struct.tx_sem = &uart3_tx_sem;
447 chThdCreateStatic(wa_thd_uart3_tx,
sizeof(wa_thd_uart3_tx),
448 NORMALPRIO + 1, thd_uart3_tx, NULL);
457#define UART4_BAUD SERIAL_DEFAULT_BITRATE
462#define USE_UART4_TX TRUE
465#define USE_UART4_RX TRUE
473#define UART4_CR2 USART_CR2_STOP1_BITS
480static SerialConfig usart4_config = {
487static struct SerialInit uart4_init_struct = SERIAL_INIT_NULL;
494static __attribute__((noreturn))
void thd_uart4_rx(
void *arg)
497 chRegSetThreadName(
"uart4_rx");
500 handle_uart_rx(&uart4);
511static __attribute__((noreturn))
void thd_uart4_tx(
void *arg)
514 chRegSetThreadName(
"uart4_tx");
517 handle_uart_tx(&uart4);
528#if USE_UART4_TX && defined UART4_GPIO_PORT_TX
531#if USE_UART4_RX && defined UART4_GPIO_PORT_RX
535 sdStart(&SD4, &usart4_config);
536 uart4.reg_addr = &SD4;
537 uart4.baudrate = UART4_BAUD;
538 uart4.init_struct = &uart4_init_struct;
539 uart4_init_struct.conf = &usart4_config;
543 uart4_init_struct.rx_mtx = &uart4_rx_mtx;
544 uart4_init_struct.rx_sem = &uart4_rx_sem;
545 chThdCreateStatic(wa_thd_uart4_rx,
sizeof(wa_thd_uart4_rx),
546 NORMALPRIO + 1, thd_uart4_rx, NULL);
549 uart4_init_struct.tx_mtx = &uart4_tx_mtx;
550 uart4_init_struct.tx_sem = &uart4_tx_sem;
551 chThdCreateStatic(wa_thd_uart4_tx,
sizeof(wa_thd_uart4_tx),
552 NORMALPRIO + 1, thd_uart4_tx, NULL);
561#define UART5_BAUD SERIAL_DEFAULT_BITRATE
566#define USE_UART5_TX TRUE
569#define USE_UART5_RX TRUE
577#define UART5_CR2 USART_CR2_STOP1_BITS
584static SerialConfig usart5_config = {
591static struct SerialInit uart5_init_struct = SERIAL_INIT_NULL;
598static __attribute__((noreturn))
void thd_uart5_rx(
void *arg)
601 chRegSetThreadName(
"uart5_rx");
604 handle_uart_rx(&uart5);
615static __attribute__((noreturn))
void thd_uart5_tx(
void *arg)
618 chRegSetThreadName(
"uart5_tx");
621 handle_uart_tx(&uart5);
632#if USE_UART5_TX && defined UART5_GPIO_PORT_TX
635#if USE_UART5_RX && defined UART5_GPIO_PORT_RX
639 sdStart(&SD5, &usart5_config);
640 uart5.reg_addr = &SD5;
641 uart5.baudrate = UART5_BAUD;
642 uart5.init_struct = &uart5_init_struct;
643 uart5_init_struct.conf = &usart5_config;
647 uart5_init_struct.rx_mtx = &uart5_rx_mtx;
648 uart5_init_struct.rx_sem = &uart5_rx_sem;
649 chThdCreateStatic(wa_thd_uart5_rx,
sizeof(wa_thd_uart5_rx),
650 NORMALPRIO + 1, thd_uart5_rx, NULL);
653 uart5_init_struct.tx_mtx = &uart5_tx_mtx;
654 uart5_init_struct.tx_sem = &uart5_tx_sem;
655 chThdCreateStatic(wa_thd_uart5_tx,
sizeof(wa_thd_uart5_tx),
656 NORMALPRIO + 1, thd_uart5_tx, NULL);
665#define UART6_BAUD SERIAL_DEFAULT_BITRATE
670#define USE_UART6_TX TRUE
673#define USE_UART6_RX TRUE
681#define UART6_CR2 USART_CR2_STOP1_BITS
688static SerialConfig usart6_config = {
695static struct SerialInit uart6_init_struct = SERIAL_INIT_NULL;
702static __attribute__((noreturn))
void thd_uart6_rx(
void *arg)
705 chRegSetThreadName(
"uart6_rx");
708 handle_uart_rx(&uart6);
719static __attribute__((noreturn))
void thd_uart6_tx(
void *arg)
722 chRegSetThreadName(
"uart6_tx");
725 handle_uart_tx(&uart6);
736#if USE_UART6_TX && defined UART6_GPIO_PORT_TX
739#if USE_UART6_RX && defined UART6_GPIO_PORT_RX
743 sdStart(&SD6, &usart6_config);
744 uart6.reg_addr = &SD6;
745 uart6.baudrate = UART6_BAUD;
746 uart6.init_struct = &uart6_init_struct;
747 uart6_init_struct.conf = &usart6_config;
751 uart6_init_struct.rx_mtx = &uart6_rx_mtx;
752 uart6_init_struct.rx_sem = &uart6_rx_sem;
753 chThdCreateStatic(wa_thd_uart6_rx,
sizeof(wa_thd_uart6_rx),
754 NORMALPRIO + 1, thd_uart6_rx, NULL);
757 uart6_init_struct.tx_mtx = &uart6_tx_mtx;
758 uart6_init_struct.tx_sem = &uart6_tx_sem;
759 chThdCreateStatic(wa_thd_uart6_tx,
sizeof(wa_thd_uart6_tx),
760 NORMALPRIO + 1, thd_uart6_tx, NULL);
763#if defined UART6_GPIO_CTS && defined UART6_GPIO_PORT_CTS
774#define UART7_BAUD SERIAL_DEFAULT_BITRATE
779#define USE_UART7_TX TRUE
782#define USE_UART7_RX TRUE
790#define UART7_CR2 USART_CR2_STOP1_BITS
797static SerialConfig usart7_config = {
804static struct SerialInit uart7_init_struct = SERIAL_INIT_NULL;
811static __attribute__((noreturn))
void thd_uart7_rx(
void *arg)
814 chRegSetThreadName(
"uart7_rx");
817 handle_uart_rx(&uart7);
828static __attribute__((noreturn))
void thd_uart7_tx(
void *arg)
831 chRegSetThreadName(
"uart7_tx");
834 handle_uart_tx(&uart7);
845#if USE_UART7_TX && defined UART7_GPIO_PORT_TX
848#if USE_UART7_RX && defined UART7_GPIO_PORT_RX
852 sdStart(&SD7, &usart7_config);
853 uart7.reg_addr = &SD7;
854 uart7.baudrate = UART7_BAUD;
855 uart7.init_struct = &uart7_init_struct;
856 uart7_init_struct.conf = &usart7_config;
860 uart7_init_struct.rx_mtx = &uart7_rx_mtx;
861 uart7_init_struct.rx_sem = &uart7_rx_sem;
862 chThdCreateStatic(wa_thd_uart7_rx,
sizeof(wa_thd_uart7_rx),
863 NORMALPRIO + 1, thd_uart7_rx, NULL);
866 uart7_init_struct.tx_mtx = &uart7_tx_mtx;
867 uart7_init_struct.tx_sem = &uart7_tx_sem;
868 chThdCreateStatic(wa_thd_uart7_tx,
sizeof(wa_thd_uart7_tx),
869 NORMALPRIO + 1, thd_uart7_tx, NULL);
878#define UART8_BAUD SERIAL_DEFAULT_BITRATE
883#define USE_UART8_TX TRUE
886#define USE_UART8_RX TRUE
894#define UART8_CR2 USART_CR2_STOP1_BITS
901static SerialConfig usart8_config = {
908static struct SerialInit uart8_init_struct = SERIAL_INIT_NULL;
915static __attribute__((noreturn))
void thd_uart8_rx(
void *arg)
918 chRegSetThreadName(
"uart8_rx");
921 handle_uart_rx(&uart8);
932static __attribute__((noreturn))
void thd_uart8_tx(
void *arg)
935 chRegSetThreadName(
"uart8_tx");
938 handle_uart_tx(&uart8);
949#if USE_UART8_TX && defined UART8_GPIO_PORT_TX
952#if USE_UART8_RX && defined UART8_GPIO_PORT_RX
956 sdStart(&SD8, &usart8_config);
957 uart8.reg_addr = &SD8;
958 uart8.baudrate = UART8_BAUD;
959 uart8.init_struct = &uart8_init_struct;
960 uart8_init_struct.conf = &usart8_config;
964 uart8_init_struct.rx_mtx = &uart8_rx_mtx;
965 uart8_init_struct.rx_sem = &uart8_rx_sem;
966 chThdCreateStatic(wa_thd_uart8_rx,
sizeof(wa_thd_uart8_rx),
967 NORMALPRIO + 1, thd_uart8_rx, NULL);
970 uart8_init_struct.tx_mtx = &uart8_tx_mtx;
971 uart8_init_struct.tx_sem = &uart8_tx_sem;
972 chThdCreateStatic(wa_thd_uart8_tx,
sizeof(wa_thd_uart8_tx),
973 NORMALPRIO + 1, thd_uart8_tx, NULL);
985 struct SerialInit *init_struct = (
struct SerialInit *)(
p->init_struct);
986 chMtxLock(init_struct->rx_mtx);
987 uint8_t ret =
p->rx_buf[
p->rx_extract_idx];
989 chMtxUnlock(init_struct->rx_mtx);
998 struct SerialInit *init_struct = (
struct SerialInit *)(
p->init_struct);
999 SerialConfig *conf = init_struct->conf;
1004 sdStop((SerialDriver *)(
p->reg_addr));
1005 sdStart((SerialDriver *)(
p->reg_addr), conf);
1012 bool rx_enabled __attribute__((unused)),
bool hw_flow_control __attribute__((unused))) {}
1013#if defined(STM32H7XX)
1014#define __USART_CR1_M USART_CR1_M0
1015#elif defined(STM32F7XX)
1016#define __USART_CR1_M USART_CR1_M_0
1017#elif defined(STM32F1XX) || defined (STM32F3XX) || defined(STM32F4XX)
1018#define __USART_CR1_M USART_CR1_M
1020#error Unsupported board
1029 struct SerialInit *init_struct = (
struct SerialInit *)(
p->init_struct);
1030 SerialConfig *conf = init_struct->conf;
1034 conf->cr1 |= USART_CR1_PCE;
1035 conf->cr1 &= ~USART_CR1_PS;
1037 conf->cr1 &= ~__USART_CR1_M;
1039 conf->cr1 |= __USART_CR1_M;
1042 conf->cr1 |= USART_CR1_PCE;
1043 conf->cr1 |= USART_CR1_PS;
1045 conf->cr1 &= ~__USART_CR1_M;
1047 conf->cr1 |= __USART_CR1_M;
1050 conf->cr1 &= ~USART_CR1_PCE;
1051 conf->cr1 &= ~__USART_CR1_M;
1054 conf->cr2 &= ~USART_CR2_STOP;
1056 conf-> cr2 |= USART_CR2_STOP2_BITS;
1058 conf-> cr2 |= USART_CR2_STOP1_BITS;
1061 sdStop((SerialDriver *)(
p->reg_addr));
1062 sdStart((SerialDriver *)(
p->reg_addr), conf);
1065#if defined(STM32F7XX) || defined(STM32H7XX)
1071 struct SerialInit *init_struct = (
struct SerialInit *)(
p->init_struct);
1072 SerialConfig *conf = init_struct->conf;
1074 conf->cr2 |= USART_CR2_RXINV;
1076 conf->cr2 &= ~USART_CR2_RXINV;
1079 conf->cr2 |= USART_CR2_TXINV;
1081 conf->cr2 &= ~USART_CR2_TXINV;
1083 sdStop((SerialDriver *)(
p->reg_addr));
1084 sdStart((SerialDriver *)(
p->reg_addr), conf);
1092 struct SerialInit *init_struct = (
struct SerialInit *)(
p->init_struct);
1093 int space =
p->tx_extract_idx -
p->tx_insert_idx - 1;
1099 chMtxLock(init_struct->tx_mtx);
1110 struct SerialInit *init_struct = (
struct SerialInit *)(
p->init_struct);
1113 chMtxLock(init_struct->tx_mtx);
1115 if (temp ==
p->tx_extract_idx) {
1116 chMtxUnlock(init_struct->tx_mtx);
1119 p->tx_buf[
p->tx_insert_idx] = data;
1120 p->tx_insert_idx = temp;
1122 chMtxUnlock(init_struct->tx_mtx);
1124 chSemSignal(init_struct->tx_sem);
1127 p->tx_buf[
p->tx_insert_idx] = data;
1137 struct SerialInit *init_struct = (
struct SerialInit *)(
p->init_struct);
1141 chMtxLock(init_struct->tx_mtx);
1142 int16_t space =
p->tx_extract_idx -
p->tx_insert_idx;
1147 chMtxUnlock(init_struct->tx_mtx);
1153 for (i = 0; i < len; i++) {
1154 p->tx_buf[
p->tx_insert_idx] = data[i];
1159 chMtxUnlock(init_struct->tx_mtx);
1161 chSemSignal(init_struct->tx_sem);
1167 struct SerialInit *init_struct = (
struct SerialInit *)(
p->init_struct);
1170 chMtxUnlock(init_struct->tx_mtx);
1173 chSemSignal(init_struct->tx_sem);
#define UART4_GPIO_PORT_RX
#define UART1_GPIO_PORT_TX
#define UART6_GPIO_PORT_RX
#define UART2_GPIO_PORT_RX
#define UART1_GPIO_PORT_RX
#define UART6_GPIO_PORT_TX
#define UART4_GPIO_PORT_TX
void gpio_setup_pin_af(ioportid_t port, uint16_t pin, uint8_t af, bool is_output)
Setup a gpio for input or output with alternate function.
static uint8_t gpio_get(ioportid_t port, uint16_t pin)
Get level of a gpio.
static THD_WORKING_AREA(wa_thd_spi1, SPI_THREAD_STACK_SIZE)
static MUTEX_DECL(sys_time_mtx)
#define UART8_GPIO_PORT_RX
#define UART3_GPIO_PORT_TX
#define UART7_GPIO_PORT_RX
#define UART8_GPIO_PORT_TX
#define UART3_GPIO_PORT_RX
#define UART2_GPIO_PORT_TX
UART2 (with optional flow control activated by default).
#define UART1_GPIO_AF
UART defines.
#define UART6_GPIO_PORT_CTS
Some architecture independent helper functions for GPIOs.
void uart_put_byte(struct uart_periph *periph, long fd, uint8_t data)
void uart_periph_set_bits_stop_parity(struct uart_periph *periph, uint8_t bits, uint8_t stop, uint8_t parity)
uint8_t uart_getch(struct uart_periph *p)
void uart_periph_set_baudrate(struct uart_periph *periph, uint32_t baud)
#define UART_TX_BUFFER_SIZE
#define UART_RX_BUFFER_SIZE
#define UART7_GPIO_PORT_TX
UART7 (Modem with optional flow control disabled by default).
#define UART5_GPIO_PORT_RX
UART5 on SRVB (DSHOT telemetry).
void WEAK uart_send_message(struct uart_periph *p, long fd)
void uart_periph_init(struct uart_periph *p)
void WEAK uart_put_buffer(struct uart_periph *p, long fd, const uint8_t *data, uint16_t len)
void WEAK uart_periph_invert_data_logic(struct uart_periph *p, bool invert_rx, bool invert_tx)
int WEAK uart_check_free_space(struct uart_periph *p, long *fd, uint16_t len)
void uart_periph_set_mode(struct uart_periph *p, bool tx_enabled, bool rx_enabled, bool hw_flow_control)
unsigned short uint16_t
Typedef defining 16 bit unsigned short type.
unsigned int uint32_t
Typedef defining 32 bit unsigned int type.
short int16_t
Typedef defining 16 bit short type.
unsigned char uint8_t
Typedef defining 8 bit unsigned char type.
static SEMAPHORE_DECL(we_ukf_sem, 0)