zoom/firmware/uart.c

#include "config.h"
#include "uart.h"

void uart_init(int uart)
{
	if (uart == 1) {
		U1MODE = 0;
		U1MODEbits.BRGH = 0;
		U1STA = 0;
		U1MODEbits.UARTEN = 1;
		U1STAbits.UTXEN = 1;
	} else if (uart == 2) {
		U2MODE = 0;
		U2MODEbits.BRGH = 0;
		U2STA = 0;
		U2MODEbits.UARTEN = 1;
		U2STAbits.UTXEN = 1;
	}			
	uart_set_rate(uart, 115200);
}
			
void uart_set_rate(int uart, int32_t rate)
{
	int32_t brg;
	
	brg = ((FCY + (8 * rate - 1)) / (16 * rate)) - 1;
	if (brg < 1) brg = 1;
	if (brg > 65535) brg = 65535;
	if (uart == 1)
		U1BRG = brg;
	else if (uart == 2)
		U2BRG = brg;
}

void uart_put(int uart, uint8_t x)
{
	if (uart == 1) {
		while (U1STAbits.UTXBF) continue;
		U1TXREG = x;
	} else if (uart == 2) {
		while (U2STAbits.UTXBF) continue;
		U2TXREG = x;
	}
}

uint8_t uart_get(int uart)
{
	uint8_t data = 0;
	if (uart == 1) {
		while (!U1STAbits.URXDA) continue;
		data = U1RXREG;
		if (U1STAbits.OERR) 
			U1STAbits.OERR = 0;
	} else if (uart == 2) {
		while (!U2STAbits.URXDA) continue;
		data = U2RXREG;
		if (U2STAbits.OERR) 
			U2STAbits.OERR = 0;
	}
	return data;
}

void uart_put_string(int uart, const char *s)
{
	while(s && *s)
		uart_put(uart, *s++);
}