altos: Add support for TeleBT v3.0

[fw/altos] / src / stm / ao_serial_stm.c

diff --git a/src/stm/ao_serial_stm.c b/src/stm/ao_serial_stm.c
index 2133c5845e0ca33233332ffc7717ad87ab49b6be..e356b9441c3e4bce2381e07ee1b88556534bf63e 100644 (file)
--- a/src/stm/ao_serial_stm.c
+++ b/src/stm/ao_serial_stm.c
@@ -63,7 +63,7 @@ int
 _ao_usart_pollchar(struct ao_stm_usart *usart)
 {
        int     c;
 _ao_usart_pollchar(struct ao_stm_usart *usart)
 {
        int     c;

-       
+

        if (ao_fifo_empty(usart->rx_fifo))
                c = AO_READ_AGAIN;
        else {
        if (ao_fifo_empty(usart->rx_fifo))
                c = AO_READ_AGAIN;
        else {


@@ -85,6 +85,12 @@ ao_usart_getchar(struct ao_stm_usart *usart)
        return (char) c;
 }
 
        return (char) c;
 }
 

+static inline uint8_t
+_ao_usart_sleep(struct ao_stm_usart *usart)
+{
+       return ao_sleep(&usart->rx_fifo);
+}
+

 void
 ao_usart_putchar(struct ao_stm_usart *usart, char c)
 {
 void
 ao_usart_putchar(struct ao_stm_usart *usart, char c)
 {


@@ -179,6 +185,13 @@ ao_usart_init(struct ao_stm_usart *usart)
        ao_usart_set_speed(usart, AO_SERIAL_SPEED_9600);
 }
 
        ao_usart_set_speed(usart, AO_SERIAL_SPEED_9600);
 }
 

+void
+ao_usart_set_flow(struct ao_stm_usart *usart)
+{
+       usart->reg->cr3 |= ((1 << STM_USART_CR3_CTSE) |
+                           (1 << STM_USART_CR3_RTSE));
+}
+

 #if HAS_SERIAL_1
 
 struct ao_stm_usart ao_stm_usart1;
 #if HAS_SERIAL_1
 
 struct ao_stm_usart ao_stm_usart1;


@@ -203,6 +216,18 @@ _ao_serial1_pollchar(void)
        return _ao_usart_pollchar(&ao_stm_usart1);
 }
 
        return _ao_usart_pollchar(&ao_stm_usart1);
 }
 

+uint8_t
+_ao_serial1_sleep(void)
+{
+       return _ao_usart_sleep(&ao_stm_usart1);
+}
+
+void
+ao_serial1_drain(void)
+{
+       ao_usart_drain(&ao_stm_usart1);
+}
+

 void
 ao_serial1_set_speed(uint8_t speed)
 {
 void
 ao_serial1_set_speed(uint8_t speed)
 {


@@ -234,6 +259,18 @@ _ao_serial2_pollchar(void)
        return _ao_usart_pollchar(&ao_stm_usart2);
 }
 
        return _ao_usart_pollchar(&ao_stm_usart2);
 }
 

+uint8_t
+_ao_serial2_sleep(void)
+{
+       return _ao_usart_sleep(&ao_stm_usart2);
+}
+
+void
+ao_serial2_drain(void)
+{
+       ao_usart_drain(&ao_stm_usart2);
+}
+

 void
 ao_serial2_set_speed(uint8_t speed)
 {
 void
 ao_serial2_set_speed(uint8_t speed)
 {


@@ -265,6 +302,12 @@ _ao_serial3_pollchar(void)
        return _ao_usart_pollchar(&ao_stm_usart3);
 }
 
        return _ao_usart_pollchar(&ao_stm_usart3);
 }
 

+uint8_t
+_ao_serial3_sleep(void)
+{
+       return _ao_usart_sleep(&ao_stm_usart3);
+}
+

 void
 ao_serial3_set_speed(uint8_t speed)
 {
 void
 ao_serial3_set_speed(uint8_t speed)
 {


@@ -324,21 +367,31 @@ ao_serial_init(void)
 
        stm_afr_set(&stm_gpioa, 2, STM_AFR_AF7);
        stm_afr_set(&stm_gpioa, 3, STM_AFR_AF7);
 
        stm_afr_set(&stm_gpioa, 2, STM_AFR_AF7);
        stm_afr_set(&stm_gpioa, 3, STM_AFR_AF7);

+#if USE_SERIAL_2_FLOW
+       stm_afr_set(&stm_gpioa, 0, STM_AFR_AF7);
+       stm_afr_set(&stm_gpioa, 1, STM_AFR_AF7);
+#endif

 #else
 #if SERIAL_2_PD5_PD6
        stm_rcc.ahbenr |= (1 << STM_RCC_AHBENR_GPIODEN);
 
        stm_afr_set(&stm_gpiod, 5, STM_AFR_AF7);
        stm_afr_set(&stm_gpiod, 6, STM_AFR_AF7);
 #else
 #if SERIAL_2_PD5_PD6
        stm_rcc.ahbenr |= (1 << STM_RCC_AHBENR_GPIODEN);
 
        stm_afr_set(&stm_gpiod, 5, STM_AFR_AF7);
        stm_afr_set(&stm_gpiod, 6, STM_AFR_AF7);

+#if USE_SERIAL_2_FLOW
+#error "Don't know how to set flowcontrol for serial 2 on PD"
+#endif

 #else
 #error "No SERIAL_2 port configuration specified"
 #else
 #error "No SERIAL_2 port configuration specified"

-#endif 
+#endif

 #endif
        /* Enable USART */
        stm_rcc.apb1enr |= (1 << STM_RCC_APB1ENR_USART2EN);
 
        ao_stm_usart2.reg = &stm_usart2;
        ao_usart_init(&ao_stm_usart2);
 #endif
        /* Enable USART */
        stm_rcc.apb1enr |= (1 << STM_RCC_APB1ENR_USART2EN);
 
        ao_stm_usart2.reg = &stm_usart2;
        ao_usart_init(&ao_stm_usart2);

+#if USE_SERIAL_2_FLOW
+       ao_usart_set_flow(&ao_stm_usart2);
+#endif

 
        stm_nvic_set_enable(STM_ISR_USART2_POS);
        stm_nvic_set_priority(STM_ISR_USART2_POS, 4);
 
        stm_nvic_set_enable(STM_ISR_USART2_POS);
        stm_nvic_set_priority(STM_ISR_USART2_POS, 4);


@@ -393,5 +446,3 @@ ao_serial_init(void)
 #endif
 #endif
 }
 #endif
 #endif
 }

-
-