#include "cpu-utils.h"
|
#include "cpu-utils.h"
|
#include "board.h"
|
#include "board.h"
|
#include "uart.h"
|
#include "uart.h"
|
|
|
const int UART_BASE_ADR[1] = {UART0_BASE};
|
const int UART_BASE_ADR[1] = {
|
const int UART_BAUDS[1] = {UART0_BAUD_RATE};
|
#ifdef UART0_BASE
|
|
UART0_BASE
|
|
#else
|
|
0
|
|
#endif
|
|
};
|
|
const int UART_BAUDS[1] = {
|
|
#ifdef UART0_BAUD_RATE
|
|
UART0_BAUD_RATE
|
|
#else
|
|
0
|
|
#endif
|
|
};
|
|
|
#define BOTH_EMPTY (UART_LSR_TEMT | UART_LSR_THRE)
|
#define BOTH_EMPTY (UART_LSR_TEMT | UART_LSR_THRE)
|
|
|
#define WAIT_FOR_XMITR(core) \
|
#define WAIT_FOR_XMITR(core) \
|
do { \
|
do { \
|
lsr = REG8(UART_BASE_ADR[core] + UART_LSR); \
|
lsr = REG8(UART_BASE_ADR[core] + UART_LSR); \
|
} while ((lsr & BOTH_EMPTY) != BOTH_EMPTY)
|
} while ((lsr & BOTH_EMPTY) != BOTH_EMPTY)
|
|
|
#define WAIT_FOR_THRE(core) \
|
#define WAIT_FOR_THRE(core) \
|
do { \
|
do { \
|
lsr = REG8(UART_BASE_ADR[core] + UART_LSR); \
|
lsr = REG8(UART_BASE_ADR[core] + UART_LSR); \
|
} while ((lsr & UART_LSR_THRE) != UART_LSR_THRE)
|
} while ((lsr & UART_LSR_THRE) != UART_LSR_THRE)
|
|
|
#define CHECK_FOR_CHAR(core) (REG8(UART_BASE_ADR[core] + UART_LSR) & UART_LSR_DR)
|
#define CHECK_FOR_CHAR(core) (REG8(UART_BASE_ADR[core] + UART_LSR) & UART_LSR_DR)
|
|
|
#define WAIT_FOR_CHAR(core) \
|
#define WAIT_FOR_CHAR(core) \
|
do { \
|
do { \
|
lsr = REG8(UART_BASE_ADR[core] + UART_LSR); \
|
lsr = REG8(UART_BASE_ADR[core] + UART_LSR); \
|
} while ((lsr & UART_LSR_DR) != UART_LSR_DR)
|
} while ((lsr & UART_LSR_DR) != UART_LSR_DR)
|
|
|
#define UART_TX_BUFF_LEN 32
|
#define UART_TX_BUFF_LEN 32
|
#define UART_TX_BUFF_MASK (UART_TX_BUFF_LEN -1)
|
#define UART_TX_BUFF_MASK (UART_TX_BUFF_LEN -1)
|
|
|
char tx_buff[UART_TX_BUFF_LEN];
|
char tx_buff[UART_TX_BUFF_LEN];
|
volatile int tx_level, rx_level;
|
volatile int tx_level, rx_level;
|
|
|
void uart_init(int core)
|
void uart_init(int core)
|
{
|
{
|
int divisor;
|
int divisor;
|
float float_divisor;
|
float float_divisor;
|
/* Reset receiver and transmiter */
|
/* Reset receiver and transmiter */
|
REG8(UART_BASE_ADR[core] + UART_FCR) = UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT | UART_FCR_TRIGGER_14;
|
REG8(UART_BASE_ADR[core] + UART_FCR) = UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT | UART_FCR_TRIGGER_14;
|
|
|
/* Disable all interrupts */
|
/* Disable all interrupts */
|
REG8(UART_BASE_ADR[core] + UART_IER) = 0x00;
|
REG8(UART_BASE_ADR[core] + UART_IER) = 0x00;
|
|
|
/* Set 8 bit char, 1 stop bit, no parity */
|
/* Set 8 bit char, 1 stop bit, no parity */
|
REG8(UART_BASE_ADR[core] + UART_LCR) = UART_LCR_WLEN8 & ~(UART_LCR_STOP | UART_LCR_PARITY);
|
REG8(UART_BASE_ADR[core] + UART_LCR) = UART_LCR_WLEN8 & ~(UART_LCR_STOP | UART_LCR_PARITY);
|
|
|
/* Set baud rate */
|
/* Set baud rate */
|
float_divisor = (float) IN_CLK/(16 * UART_BAUDS[core]);
|
float_divisor = (float) IN_CLK/(16 * UART_BAUDS[core]);
|
float_divisor += 0.50f; // Ensure round up
|
float_divisor += 0.50f; // Ensure round up
|
divisor = (int) float_divisor;
|
divisor = (int) float_divisor;
|
|
|
REG8(UART_BASE_ADR[core] + UART_LCR) |= UART_LCR_DLAB;
|
REG8(UART_BASE_ADR[core] + UART_LCR) |= UART_LCR_DLAB;
|
REG8(UART_BASE_ADR[core] + UART_DLL) = divisor & 0x000000ff;
|
REG8(UART_BASE_ADR[core] + UART_DLL) = divisor & 0x000000ff;
|
REG8(UART_BASE_ADR[core] + UART_DLM) = (divisor >> 8) & 0x000000ff;
|
REG8(UART_BASE_ADR[core] + UART_DLM) = (divisor >> 8) & 0x000000ff;
|
REG8(UART_BASE_ADR[core] + UART_LCR) &= ~(UART_LCR_DLAB);
|
REG8(UART_BASE_ADR[core] + UART_LCR) &= ~(UART_LCR_DLAB);
|
|
|
return;
|
return;
|
}
|
}
|
|
|
void uart_putc(int core, char c)
|
void uart_putc(int core, char c)
|
{
|
{
|
unsigned char lsr;
|
unsigned char lsr;
|
|
|
WAIT_FOR_THRE(core);
|
WAIT_FOR_THRE(core);
|
REG8(UART_BASE_ADR[core] + UART_TX) = c;
|
REG8(UART_BASE_ADR[core] + UART_TX) = c;
|
if(c == '\n') {
|
if(c == '\n') {
|
WAIT_FOR_THRE(core);
|
WAIT_FOR_THRE(core);
|
REG8(UART_BASE_ADR[core] + UART_TX) = '\r';
|
REG8(UART_BASE_ADR[core] + UART_TX) = '\r';
|
}
|
}
|
WAIT_FOR_XMITR(core);
|
WAIT_FOR_XMITR(core);
|
}
|
}
|
|
|
// Only used when we know THRE is empty, typically in interrupt
|
// Only used when we know THRE is empty, typically in interrupt
|
void uart_putc_noblock(int core, char c)
|
void uart_putc_noblock(int core, char c)
|
{
|
{
|
REG8(UART_BASE_ADR[core] + UART_TX) = c;
|
REG8(UART_BASE_ADR[core] + UART_TX) = c;
|
}
|
}
|
|
|
|
|
char uart_getc(int core)
|
char uart_getc(int core)
|
{
|
{
|
unsigned char lsr;
|
unsigned char lsr;
|
char c;
|
char c;
|
|
|
WAIT_FOR_CHAR(core);
|
WAIT_FOR_CHAR(core);
|
c = REG8(UART_BASE_ADR[core] + UART_RX);
|
c = REG8(UART_BASE_ADR[core] + UART_RX);
|
return c;
|
return c;
|
}
|
}
|
|
|
int uart_check_for_char(int core)
|
int uart_check_for_char(int core)
|
{
|
{
|
return CHECK_FOR_CHAR(core);
|
return CHECK_FOR_CHAR(core);
|
}
|
}
|
|
|
void uart_rxint_enable(int core)
|
void uart_rxint_enable(int core)
|
{
|
{
|
REG8(UART_BASE_ADR[core] + UART_IER) |= UART_IER_RDI;
|
REG8(UART_BASE_ADR[core] + UART_IER) |= UART_IER_RDI;
|
}
|
}
|
|
|
void uart_rxint_disable(int core)
|
void uart_rxint_disable(int core)
|
{
|
{
|
REG8(UART_BASE_ADR[core] + UART_IER) &= ~(UART_IER_RDI);
|
REG8(UART_BASE_ADR[core] + UART_IER) &= ~(UART_IER_RDI);
|
}
|
}
|
|
|
void uart_txint_enable(int core)
|
void uart_txint_enable(int core)
|
{
|
{
|
REG8(UART_BASE_ADR[core] + UART_IER) |= UART_IER_THRI;
|
REG8(UART_BASE_ADR[core] + UART_IER) |= UART_IER_THRI;
|
}
|
}
|
|
|
void uart_txint_disable(int core)
|
void uart_txint_disable(int core)
|
{
|
{
|
REG8(UART_BASE_ADR[core] + UART_IER) &= ~(UART_IER_THRI);
|
REG8(UART_BASE_ADR[core] + UART_IER) &= ~(UART_IER_THRI);
|
}
|
}
|
|
|
char uart_get_iir(int core)
|
char uart_get_iir(int core)
|
{
|
{
|
return REG8(UART_BASE_ADR[core] + UART_IIR);
|
return REG8(UART_BASE_ADR[core] + UART_IIR);
|
}
|
}
|
|
|
|
|
char uart_get_lsr(int core)
|
char uart_get_lsr(int core)
|
{
|
{
|
return REG8(UART_BASE_ADR[core] + UART_LSR);
|
return REG8(UART_BASE_ADR[core] + UART_LSR);
|
}
|
}
|
|
|
|
|
char uart_get_msr(int core)
|
char uart_get_msr(int core)
|
{
|
{
|
return REG8(UART_BASE_ADR[core] + UART_MSR);
|
return REG8(UART_BASE_ADR[core] + UART_MSR);
|
}
|
}
|
|
|
