'hardening' infrastucture against toolchain bugs

[arm-crypto-lib.git] / test_src / uart_i.c

diff --git a/test_src/uart_i.c b/test_src/uart_i.c
index 37c6c7da1f0a210ada7a89e7a603ff48a06c8bee..539dc222c81d72d1d145ec73cce4a91750f4060a 100644 (file)
--- a/test_src/uart_i.c
+++ b/test_src/uart_i.c
@@ -23,7 +23,7 @@
 #include "hw_uart_regs.h"
 #include "uart_defines.h"
 #include "circularbytebuffer.h"
-#include "uart_lowlevel.h"
+
 
 static const
 uint32_t uart_base[] = { UART0_BASE, UART1_BASE, UART2_BASE };
@@ -54,10 +54,6 @@ static const
 uint32_t uart_rx_buffersize[] = {128, 128, 128};
 static const
 uint32_t uart_tx_buffersize[] = {256, 256, 256};
-static
-uint8_t uart_swflowctrl_en[] = {0, 0, 0};
-static
-uint8_t uart_swflowctrl_halt[] = {0, 0, 0};
 
 static
 circularbytebuffer_t uart_rx_buffer[3];
@@ -71,6 +67,7 @@ static
 void uart_rx_isr(uint8_t uartno);
 
 void uart0_isr(void){
+
        if(HW_REG(UART0_BASE+UARTMIS_OFFSET)&_BV(UART_TXMIS)){
 //             HW_REG(uart_base[0]+UARTDR_OFFSET) = 'X';
                uart_tx_isr(UART_0);
@@ -84,8 +81,7 @@ static
 void uart_tx_isr(uint8_t uartno){
        uint32_t tmp;
        tmp = circularbytebuffer_cnt(&(uart_tx_buffer[uartno]));
-       while(tmp-- && (!(HW_REG(uart_base[uartno]+UARTFR_OFFSET)&_BV(UART_TXFF)))
-                 && !(uart_swflowctrl_en[uartno] && uart_swflowctrl_halt[uartno])){
+       while(tmp-- && (!(HW_REG(uart_base[uartno]+UARTFR_OFFSET)&_BV(UART_TXFF)))){
                HW_REG(uart_base[uartno]+UARTDR_OFFSET)
                                = (uint32_t)circularbytebuffer_get_fifo(&(uart_tx_buffer[uartno]));
        }
@@ -95,21 +91,9 @@ void uart_tx_isr(uint8_t uartno){
 static
 void uart_rx_isr(uint8_t uartno){
        uint8_t c;
-       while(!HW_REG(uart_base[uartno]+UARTFR_OFFSET)&_BV(UART_RXFE)){
+       while(!(HW_REG(uart_base[uartno]+UARTFR_OFFSET)&_BV(UART_RXFE))){
                c = HW_REG(uart_base[uartno]+UARTDR_OFFSET);
-               if(uart_swflowctrl_en[uartno]){
-                       circularbytebuffer_append(c, &(uart_rx_buffer[uartno]));
-               }else{
-                       if(c==UART_XON_CHAR){
-                               uart_swflowctrl_halt[uartno] = 0;
-                       }else{
-                               if(c==UART_XOFF_CHAR){
-                                       uart_swflowctrl_halt[uartno] = 1;
-                               }else{
-                                       circularbytebuffer_append(c, &(uart_rx_buffer[uartno]));
-                               }
-                       }
-               }
+               circularbytebuffer_append(c, &(uart_rx_buffer[uartno]));
        }
        HW_REG(uart_base[uartno]+UARTICR_OFFSET) |= _BV(UART_RXIC);
 }
@@ -117,20 +101,21 @@ void uart_rx_isr(uint8_t uartno){
 void calc_baud_values(uint32_t baudrate, uint16_t* intdivider, uint8_t* fracdivider, uint8_t* highspeed){
        uint32_t tmp;
        uint32_t uart_freq;
+       if(baudrate==0){
+               return;
+       }
        uart_freq = sysclk_get_freq();
-       *highspeed = (baudrate*16>uart_freq)?1:0;
-       tmp = (uint64_t)uart_freq*128/((*highspeed?8:16)*baudrate);
+       *highspeed = ((baudrate*16L)>uart_freq)?1:0;
+//     tmp = (((uint64_t)UART_FREQ)*128LL)/(((*highspeed)?8L:16L)*baudrate);
+       tmp = uart_freq<<((*highspeed)?(7-3):(7-4));
+       tmp /= baudrate;
        tmp++;
        tmp>>=1;
        *fracdivider = (uint8_t)(tmp&0x3f);
-       *intdivider = tmp>>6;
+       *intdivider = (uint16_t)(tmp>>6);
 }
 
 uint8_t uart_init(uint8_t uartno, uint32_t baudrate, uint8_t databits, uint8_t paraty, uint8_t stopbits){
-       return uart_init_flow(uartno, baudrate, databits, paraty, stopbits, 0);
-}
-
-uint8_t uart_init_flow(uint8_t uartno, uint32_t baudrate, uint8_t databits, uint8_t paraty, uint8_t stopbits, uint8_t flowctrl){
        uint32_t tmp;
        if(databits>=5){
                databits-=5;
@@ -153,12 +138,17 @@ uint8_t uart_init_flow(uint8_t uartno, uint32_t baudrate, uint8_t databits, uint
        if(0==circularbytebuffer_init(uart_tx_buffersize[uartno], &(uart_tx_buffer[uartno]))){
                return UART_ERROR_TX_BUFFER_INIT;
        }
-       /* enable clock for uart */
-       HW_REG(SYSCTL_BASE+RCGC1_OFFSET) |= _BV(uartno);
        /* enable clock for gpio*/
        HW_REG(SYSCTL_BASE+RCGC2_OFFSET) |= _BV(uart_rx_gpio[uartno]) | _BV(uart_tx_gpio[uartno]);
+    for(tmp=0; tmp<100; ++tmp)
+       ;
     HW_REG(SYSCTL_BASE+RCGC2_OFFSET) |= 1;
-
+    for(tmp=0; tmp<100; ++tmp)
+       ;
+       /* enable clock for uart */
+       HW_REG(SYSCTL_BASE+RCGC1_OFFSET) |= _BV(uartno);
+    for(tmp=0; tmp<100; ++tmp)
+       ;
     HW_REG(gpio_base[uart_rx_gpio[uartno]] + GPIO_ODR_OFFSET) &= ~_BV(uart_rx_pin[uartno]); /* open drain */
     HW_REG(gpio_base[uart_tx_gpio[uartno]] + GPIO_ODR_OFFSET) &= ~_BV(uart_tx_pin[uartno]); /* open drain */
     HW_REG(gpio_base[uart_rx_gpio[uartno]] + GPIO_PUR_OFFSET) &= ~_BV(uart_rx_pin[uartno]); /* pull-up */
@@ -185,20 +175,25 @@ uint8_t uart_init_flow(uint8_t uartno, uint32_t baudrate, uint8_t databits, uint
        HW_REG(gpio_base[uart_rx_gpio[uartno]]+GPIO_DIR_OFFSET) &= ~_BV(uart_rx_pin[uartno]);
        /* configure tx pin as output */
        HW_REG(gpio_base[uart_tx_gpio[uartno]]+GPIO_DIR_OFFSET) |= _BV(uart_tx_pin[uartno]);
-
+    for(tmp=0; tmp<100; ++tmp)
+       ;
        /* disable uart */
        HW_REG(uart_base[uartno]+UARTCTL_OFFSET) &= ~_BV(UART_UARTEN);
        /* set baudrate parameters */
-       uint8_t highspeed;
-       calc_baud_values(baudrate,
-                                (uint16_t*)&HW_REG(uart_base[uartno]+UARTIBRD_OFFSET),
-                                (uint8_t*)&HW_REG(uart_base[uartno]+UARTFBRD_OFFSET),
-                                &highspeed);
+       uint8_t highspeed, fbrd;
+       uint16_t ibrd;
+       calc_baud_values(baudrate, &ibrd, &fbrd, &highspeed);
+       tmp=HW_REG(uart_base[uartno]+UARTLCRH_OFFSET);
+       HW16_REG(uart_base[uartno]+UARTIBRD_OFFSET) = ibrd;
+    HW8_REG(uart_base[uartno]+UARTFBRD_OFFSET) = fbrd;
+    HW_REG(uart_base[uartno]+UARTLCRH_OFFSET) = tmp;
        /* wait until uart is no longer busy */
        while(HW_REG(uart_base[uartno]+UARTFR_OFFSET)&_BV(UART_BUSY))
                ;
+
        /* flush FIFOs */
        HW_REG(uart_base[uartno]+UARTLCRH_OFFSET) &= ~_BV(UART_FEN);
+
        /* set line parameters (bits, paraty, stopbits*/
        tmp = HW_REG(uart_base[uartno]+UARTLCRH_OFFSET);
        tmp &= ~0xff;
@@ -215,16 +210,9 @@ uint8_t uart_init_flow(uint8_t uartno, uint32_t baudrate, uint8_t databits, uint
        } else {
                HW_REG(uart_base[uartno]+UARTCTL_OFFSET) &= ~_BV(UART_HSE);
        }
-       /* set flow control */
-       if(flowctrl==UART_FLOWCTRL_SOFT){
-               uart_swflowctrl_en[uartno] = 1;
-               uart_swflowctrl_halt[uartno] = 0;
-       }else{
-               uart_swflowctrl_en[uartno] = 0;
-       }
        /* uart interrupt enable */
        HW_REG(uart_base[uartno]+UARTIM_OFFSET) |= _BV(UART_TXIM) | _BV(UART_RXIM);
-       HW_REG(ISR_ENABLE_VECTOR+uart_isr_vector[uartno]/32) |=
+       HW_REG(ISR_ENABLE_VECTOR+4*(uart_isr_vector[uartno]/32)) |=
                        _BV(uart_isr_vector[uartno]%32);
 
        HW_REG(uart_base[uartno]+UARTCTL_OFFSET) |= _BV(UART_EOT);
@@ -278,3 +266,14 @@ uint32_t uart_dataavail(uint8_t uartno){
        }
        return(HW_REG(uart_base[uartno]+UARTFR_OFFSET)&_BV(UART_RXFE))?0:1;
 }
+
+
+void uart_flush(uint8_t uartno){
+       if(uartno>UART_MAX){
+               return;
+       }
+       while(circularbytebuffer_cnt(&(uart_tx_buffer[uartno])))
+               ;
+       while((HW_REG(uart_base[uartno]+UARTCTL_OFFSET)&_BV(UART_EOT)) == 0)
+               ;
+}