altos/stm: New compiler doesn't correctly build flash bits yet
[fw/altos] / src / stm / ao_serial_stm.c
index 9302bdf813db462c244e095a2b12306d75b589d5..2133c5845e0ca33233332ffc7717ad87ab49b6be 100644 (file)
 
 #include <ao.h>
 
-struct ao_stm_usart {
-       struct ao_fifo          rx_fifo;
-       struct ao_fifo          tx_fifo;
-       struct stm_usart        *reg;
-       uint8_t                 tx_started;
-};
-
-#if HAS_SERIAL_1
-struct ao_stm_usart ao_stm_usart1;
-#endif
-#if HAS_SERIAL_2
-struct ao_stm_usart ao_stm_usart2;
-#endif
-#if HAS_SERIAL_3
-struct ao_stm_usart ao_stm_usart3;
-#endif
-
 void
 ao_debug_out(char c)
 {
@@ -43,16 +26,8 @@ ao_debug_out(char c)
        stm_usart1.dr = c;
 }
 
-#if 0
-void
-outbyte(char c)
-{
-       putchar(c);
-}
-#endif
-
 static void
-ao_usart_tx_start(struct ao_stm_usart *usart)
+_ao_usart_tx_start(struct ao_stm_usart *usart)
 {
        if (!ao_fifo_empty(usart->tx_fifo) && !usart->tx_started)
        {
@@ -79,90 +54,83 @@ ao_usart_isr(struct ao_stm_usart *usart, int stdin)
        }
        if (sr & (1 << STM_USART_SR_TC)) {
                usart->tx_started = 0;
-               ao_usart_tx_start(usart);
+               _ao_usart_tx_start(usart);
                ao_wakeup(&usart->tx_fifo);
        }
 }
 
-#if HAS_SERIAL_1
-void stm_usart1_isr(void) { ao_usart_isr(&ao_stm_usart1, USE_SERIAL_STDIN); }
-#endif
-#if HAS_SERIAL_2
-void stm_usart2_isr(void) { ao_usart_isr(&ao_stm_usart2, 0); }
-#endif
-#if HAS_SERIAL_3
-void stm_usart3_isr(void) { ao_usart_isr(&ao_stm_usart3, 0); }
-#endif
-
-char
-ao_usart_getchar(struct ao_stm_usart *usart)
+int
+_ao_usart_pollchar(struct ao_stm_usart *usart)
 {
-       char c;
-       cli();
-       while (ao_fifo_empty(usart->rx_fifo))
-               ao_sleep(&usart->rx_fifo);
-       ao_fifo_remove(usart->rx_fifo, c);
-       sei();
+       int     c;
+       
+       if (ao_fifo_empty(usart->rx_fifo))
+               c = AO_READ_AGAIN;
+       else {
+               uint8_t u;
+               ao_fifo_remove(usart->rx_fifo,u);
+               c = u;
+       }
        return c;
 }
 
 char
-ao_usart_pollchar(struct ao_stm_usart *usart)
+ao_usart_getchar(struct ao_stm_usart *usart)
 {
-       char    c;
-       cli();
-       if (ao_fifo_empty(usart->rx_fifo)) {
-               sei();
-               return AO_READ_AGAIN;
-       }
-       ao_fifo_remove(usart->rx_fifo,c);
-       sei();
-       return c;
+       int c;
+       ao_arch_block_interrupts();
+       while ((c = _ao_usart_pollchar(usart)) == AO_READ_AGAIN)
+               ao_sleep(&usart->rx_fifo);
+       ao_arch_release_interrupts();
+       return (char) c;
 }
 
 void
 ao_usart_putchar(struct ao_stm_usart *usart, char c)
 {
-       cli();
+       ao_arch_block_interrupts();
        while (ao_fifo_full(usart->tx_fifo))
                ao_sleep(&usart->tx_fifo);
        ao_fifo_insert(usart->tx_fifo, c);
-       ao_usart_tx_start(usart);
-       sei();
+       _ao_usart_tx_start(usart);
+       ao_arch_release_interrupts();
 }
 
 void
 ao_usart_drain(struct ao_stm_usart *usart)
 {
-       cli();
+       ao_arch_block_interrupts();
        while (!ao_fifo_empty(usart->tx_fifo))
                ao_sleep(&usart->tx_fifo);
-       sei();
+       ao_arch_release_interrupts();
 }
 
 static const struct {
        uint32_t brr;
 } ao_usart_speeds[] = {
        [AO_SERIAL_SPEED_4800] = {
-               STM_APB1 / 4800
+               AO_PCLK1 / 4800
        },
        [AO_SERIAL_SPEED_9600] = {
-               STM_APB1 / 9600
+               AO_PCLK1 / 9600
        },
        [AO_SERIAL_SPEED_19200] = {
-               STM_APB1 / 19200
+               AO_PCLK1 / 19200
        },
        [AO_SERIAL_SPEED_57600] = {
-               STM_APB1 / 57600
+               AO_PCLK1 / 57600
+       },
+       [AO_SERIAL_SPEED_115200] = {
+               AO_PCLK1 / 115200
        },
 };
 
 void
 ao_usart_set_speed(struct ao_stm_usart *usart, uint8_t speed)
 {
-       if (speed > AO_SERIAL_SPEED_57600)
+       if (speed > AO_SERIAL_SPEED_115200)
                return;
-       stm_usart1.brr = ao_usart_speeds[speed].brr;
+       usart->reg->brr = ao_usart_speeds[speed].brr;
 }
 
 void
@@ -211,33 +179,135 @@ ao_usart_init(struct ao_stm_usart *usart)
        ao_usart_set_speed(usart, AO_SERIAL_SPEED_9600);
 }
 
+#if HAS_SERIAL_1
+
+struct ao_stm_usart ao_stm_usart1;
+
+void stm_usart1_isr(void) { ao_usart_isr(&ao_stm_usart1, USE_SERIAL_1_STDIN); }
+
+char
+ao_serial1_getchar(void)
+{
+       return ao_usart_getchar(&ao_stm_usart1);
+}
+
+void
+ao_serial1_putchar(char c)
+{
+       ao_usart_putchar(&ao_stm_usart1, c);
+}
+
+int
+_ao_serial1_pollchar(void)
+{
+       return _ao_usart_pollchar(&ao_stm_usart1);
+}
+
+void
+ao_serial1_set_speed(uint8_t speed)
+{
+       ao_usart_set_speed(&ao_stm_usart1, speed);
+}
+#endif /* HAS_SERIAL_1 */
+
+#if HAS_SERIAL_2
+
+struct ao_stm_usart ao_stm_usart2;
+
+void stm_usart2_isr(void) { ao_usart_isr(&ao_stm_usart2, USE_SERIAL_2_STDIN); }
+
+char
+ao_serial2_getchar(void)
+{
+       return ao_usart_getchar(&ao_stm_usart2);
+}
+
+void
+ao_serial2_putchar(char c)
+{
+       ao_usart_putchar(&ao_stm_usart2, c);
+}
+
+int
+_ao_serial2_pollchar(void)
+{
+       return _ao_usart_pollchar(&ao_stm_usart2);
+}
+
+void
+ao_serial2_set_speed(uint8_t speed)
+{
+       ao_usart_set_speed(&ao_stm_usart2, speed);
+}
+#endif /* HAS_SERIAL_2 */
+
+#if HAS_SERIAL_3
+
+struct ao_stm_usart ao_stm_usart3;
+
+void stm_usart3_isr(void) { ao_usart_isr(&ao_stm_usart3, USE_SERIAL_2_STDIN); }
+
+char
+ao_serial3_getchar(void)
+{
+       return ao_usart_getchar(&ao_stm_usart3);
+}
+
+void
+ao_serial3_putchar(char c)
+{
+       ao_usart_putchar(&ao_stm_usart3, c);
+}
+
+int
+_ao_serial3_pollchar(void)
+{
+       return _ao_usart_pollchar(&ao_stm_usart3);
+}
+
+void
+ao_serial3_set_speed(uint8_t speed)
+{
+       ao_usart_set_speed(&ao_stm_usart3, speed);
+}
+#endif /* HAS_SERIAL_3 */
+
 void
 ao_serial_init(void)
 {
-#ifdef HAS_SERIAL_1
+#if HAS_SERIAL_1
        /*
         *      TX      RX
         *      PA9     PA10
-        *      PB6     PB7
+        *      PB6     PB7     *
         */
 
+#if SERIAL_1_PA9_PA10
        stm_rcc.ahbenr |= (1 << STM_RCC_AHBENR_GPIOAEN);
 
-       stm_moder_set(&stm_gpioa, 9, STM_MODER_ALTERNATE);
-       stm_moder_set(&stm_gpioa, 10, STM_MODER_ALTERNATE);
        stm_afr_set(&stm_gpioa, 9, STM_AFR_AF7);
        stm_afr_set(&stm_gpioa, 10, STM_AFR_AF7);
-       
+#else
+#if SERIAL_1_PB6_PB7
+       stm_rcc.ahbenr |= (1 << STM_RCC_AHBENR_GPIOBEN);
+
+       stm_afr_set(&stm_gpiob, 6, STM_AFR_AF7);
+       stm_afr_set(&stm_gpiob, 7, STM_AFR_AF7);
+#else
+#error "No SERIAL_1 port configuration specified"
+#endif
+#endif
        /* Enable USART */
        stm_rcc.apb2enr |= (1 << STM_RCC_APB2ENR_USART1EN);
 
        ao_stm_usart1.reg = &stm_usart1;
+       ao_usart_init(&ao_stm_usart1);
 
        stm_nvic_set_enable(STM_ISR_USART1_POS);
        stm_nvic_set_priority(STM_ISR_USART1_POS, 4);
-#if USE_SERIAL_STDIN
-       ao_add_stdio(ao_serial_pollchar,
-                    ao_serial_putchar,
+#if USE_SERIAL_1_STDIN
+       ao_add_stdio(_ao_serial1_pollchar,
+                    ao_serial1_putchar,
                     NULL);
 #endif
 #endif
@@ -249,20 +319,34 @@ ao_serial_init(void)
         *      PD5     PD6
         */
 
+#if SERIAL_2_PA2_PA3
        stm_rcc.ahbenr |= (1 << STM_RCC_AHBENR_GPIOAEN);
 
-       stm_moder_set(&stm_gpioa, 2, STM_MODER_ALTERNATE);
-       stm_moder_set(&stm_gpioa, 3, STM_MODER_ALTERNATE);
        stm_afr_set(&stm_gpioa, 2, STM_AFR_AF7);
        stm_afr_set(&stm_gpioa, 3, 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);
+#else
+#error "No SERIAL_2 port configuration specified"
+#endif 
+#endif
        /* Enable USART */
        stm_rcc.apb1enr |= (1 << STM_RCC_APB1ENR_USART2EN);
 
        ao_stm_usart2.reg = &stm_usart2;
+       ao_usart_init(&ao_stm_usart2);
 
        stm_nvic_set_enable(STM_ISR_USART2_POS);
        stm_nvic_set_priority(STM_ISR_USART2_POS, 4);
+#if USE_SERIAL_2_STDIN
+       ao_add_stdio(_ao_serial2_pollchar,
+                    ao_serial2_putchar,
+                    NULL);
+#endif
 #endif
 
 #if HAS_SERIAL_3
@@ -272,43 +356,42 @@ ao_serial_init(void)
         *      PC10    PC11
         *      PD8     PD9
         */
+#if SERIAL_3_PB10_PB11
        stm_rcc.ahbenr |= (1 << STM_RCC_AHBENR_GPIOBEN);
 
-       stm_moder_set(&stm_gpiob, 10, STM_MODER_ALTERNATE);
-       stm_moder_set(&stm_gpiob, 11, STM_MODER_ALTERNATE);
        stm_afr_set(&stm_gpiob, 10, STM_AFR_AF7);
        stm_afr_set(&stm_gpiob, 11, STM_AFR_AF7);
-       
+#else
+#if SERIAL_3_PC10_PC11
+       stm_rcc.ahbenr |= (1 << STM_RCC_AHBENR_GPIOCEN);
+
+       stm_afr_set(&stm_gpioc, 10, STM_AFR_AF7);
+       stm_afr_set(&stm_gpioc, 11, STM_AFR_AF7);
+#else
+#if SERIAL_3_PD8_PD9
+       stm_rcc.ahbenr |= (1 << STM_RCC_AHBENR_GPIODEN);
+
+       stm_afr_set(&stm_gpiod, 8, STM_AFR_AF7);
+       stm_afr_set(&stm_gpiod, 9, STM_AFR_AF7);
+#else
+#error "No SERIAL_3 port configuration specified"
+#endif
+#endif
+#endif
        /* Enable USART */
        stm_rcc.apb1enr |= (1 << STM_RCC_APB1ENR_USART3EN);
 
        ao_stm_usart3.reg = &stm_usart3;
+       ao_usart_init(&ao_stm_usart3);
 
        stm_nvic_set_enable(STM_ISR_USART3_POS);
        stm_nvic_set_priority(STM_ISR_USART3_POS, 4);
+#if USE_SERIAL_3_STDIN
+       ao_add_stdio(_ao_serial3_pollchar,
+                    ao_serial3_putchar,
+                    NULL);
 #endif
-}
-
-#if HAS_SERIAL_1
-char
-ao_serial_getchar(void)
-{
-       return ao_usart_getchar(&ao_stm_usart1);
-}
-
-#if USE_SERIAL_STDIN
-char
-ao_serial_pollchar(void)
-{
-       return ao_usart_pollchar(&ao_stm_usart1);
-}
 #endif
-
-void
-ao_serial_putchar(char c)
-{
-       ao_usart_putchar(&ao_stm_usart1, c);
 }
-#endif /* HAS_SERIAL_1 */