47 lines
958 B
C
47 lines
958 B
C
|
#include "Serial.h"
|
||
|
|
#include <util/setbaud.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <string.h>
|
||
|
|
|
||
|
|
void serial_init(Serial *serial) {
|
||
|
|
memset(serial, 0, sizeof(*serial));
|
||
|
|
UBRR0H = UBRRH_VALUE;
|
||
|
|
UBRR0L = UBRRL_VALUE;
|
||
|
|
|
||
|
|
#if USE_2X
|
||
|
|
UCSR0A |= _BV(U2X0);
|
||
|
|
#else
|
||
|
|
UCSR0A &= ~(_BV(U2X0));
|
||
|
|
#endif
|
||
|
|
|
||
|
|
// Set to 8-bit data, enable RX and TX
|
||
|
|
UCSR0C = _BV(UCSZ01) | _BV(UCSZ00);
|
||
|
|
UCSR0B = _BV(RXEN0) | _BV(TXEN0);
|
||
|
|
|
||
|
|
FILE uart0_fd = FDEV_SETUP_STREAM(uart0_putchar, uart0_getchar, _FDEV_SETUP_RW);
|
||
|
|
|
||
|
|
serial->uart0 = uart0_fd;
|
||
|
|
}
|
||
|
|
|
||
|
|
bool serial_available(uint8_t index) {
|
||
|
|
if (index == 0) {
|
||
|
|
if (UCSR0A & _BV(RXC0)) return true;
|
||
|
|
}
|
||
|
|
return false;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
void uart0_putchar(char c) {
|
||
|
|
loop_until_bit_is_set(UCSR0A, UDRE0);
|
||
|
|
UDR0 = c;
|
||
|
|
}
|
||
|
|
|
||
|
|
char uart0_getchar(void) {
|
||
|
|
loop_until_bit_is_set(UCSR0A, RXC0);
|
||
|
|
return UDR0;
|
||
|
|
}
|
||
|
|
|
||
|
|
char uart0_getchar_nowait(void) {
|
||
|
|
if (!(UCSR0A & _BV(RXC0))) return EOF;
|
||
|
|
return UDR0;
|
||
|
|
}
|