Subversion Repositories riscv_vhdl

#include <stdio.h>
#include <stdarg.h>
#ifdef CONFIG_RISCV64
#include <axi_maps.h>
#elif CONFIG_LEON3
#include "leon3_config.h"
#endif
 
static const int BUF_LENGTH = 2048;
static char tmpUartStr[BUF_LENGTH];
 
//****************************************************************************
extern "C" void uart_init() {
#ifdef CONFIG_RISCV64
    //uart_map *uart = (uart_map *)ADDR_NASTI_SLAVE_UART1;
    // Inited in bootloader
#elif CONFIG_LEON3
    uart_fields *uart = (uart_fields *)ADR_APBUART_BASE;
    // scaler = 66MHz/(8*(1+rate)) = 115200 = 71
    uart->scaler = 71;       // 115200 baudrate
    // Init port for the transmition:
    uart->control = UART_CTRL_ENABLE_TX;//|UART_CTRL_TSEMPTY_IRQEN;
#endif
}
 
extern "C" int uart_busy() {
#ifdef CONFIG_RISCV64
    uart_map *uart = (uart_map *)ADDR_NASTI_SLAVE_UART1;
    return uart->status & UART_STATUS_TX_FULL;
 
#elif CONFIG_LEON3
    uart_fields *uart = (uart_fields *)ADR_APBUART_BASE;
    return uart->status & UART_STATUS_TFULL;
#endif
}
 
extern "C" void uart_send(unsigned v) {
#ifdef CONFIG_RISCV64
    uart_map *uart = (uart_map *)ADDR_NASTI_SLAVE_UART1;
    uart->data = v;
#elif CONFIG_LEON3
    uart_fields *uart = (uart_fields *)ADR_APBUART_BASE;
    uart->data = v;
#endif
}
 
//****************************************************************************
extern "C" int printf_uart(const char *_format, ... ) {
    int ret = 0;
 
    va_list arg;
    va_start(arg, _format );
 
    ret = vsprintf(tmpUartStr, _format, arg );
    va_end( arg );
 
    for (int i = 0; i < ret; i++) {
        while(uart_busy()) {}
        uart_send((unsigned int)tmpUartStr[i]);
    }
    return ret;
}