Updated send and recv files to use rfm.

1 files changed, 33 insertions, 0 deletions

diff --git a/rf_test/serial.c b/rf_test/serial.c
new file mode 100644
index 0000000..0b9aecf
--- /dev/null
+++ b/rf_test/serial.c
@@ -0,0 +1,33 @@
+#include <avr/io.h>
+#include <util/setbaud.h>
+
+#include "serial.h"
+
+void serial_init(void)
+{
+	UBRR0H = UBRRH_VALUE;
+	UBRR0L = UBRRL_VALUE;
+#if USE_2X
+	UCSR0A |= (1 << U2X0);
+#else
+	UCSR0A &= ~(1 << U2X0);
+#endif
+	UCSR0B = (1 << TXEN0) | (1 << RXEN0);
+	UCSR0C = (1 << UCSZ01) | (1 << UCSZ00);
+}
+
+static void serial_write(unsigned char data)
+{
+	while (!(UCSR0A & (1 << UDRE0)))
+		;
+	UDR0 = data;
+}
+
+void serial_write_line(const char *s)
+{
+	for (; *s; s++)
+		serial_write(*s);
+
+	serial_write('\r');
+	serial_write('\n');
+}