diff options
Diffstat (limited to 'src/arch/lora32u4ii/driver/stdout.cc')
-rw-r--r-- | src/arch/lora32u4ii/driver/stdout.cc | 36 |
1 files changed, 36 insertions, 0 deletions
diff --git a/src/arch/lora32u4ii/driver/stdout.cc b/src/arch/lora32u4ii/driver/stdout.cc new file mode 100644 index 0000000..afe6ff8 --- /dev/null +++ b/src/arch/lora32u4ii/driver/stdout.cc @@ -0,0 +1,36 @@ +#include "driver/stdout.h" +#include <avr/io.h> +#include <avr/interrupt.h> + +#ifndef BAUD +#define BAUD 9600UL +#endif + +#include <util/setbaud.h> + +void StandardOutput::setup() +{ + UBRR1H = UBRRH_VALUE; + UBRR1L = UBRRL_VALUE; + +#if USE_2X + UCSR1A |= _BV(U2X1); +#else + UCSR1A &= ~_BV(U2X1); +#endif + + UCSR1B |= _BV(RXEN1) | _BV(TXEN1); + UCSR1C = _BV(UCSZ11) | _BV(UCSZ10); // async UART, 8N1 + //UCSR1D = 0; +} + +void StandardOutput::put(char c) +{ + while (!(UCSR1A & _BV(UDRE1))); + UDR1 = c; + if (c == '\n') { + put('\r'); + } +} + +StandardOutput kout; |