From 307cfe164910eccc70c086c083595d637c7fb987 Mon Sep 17 00:00:00 2001
From: Vegard Storheil Eriksen <zyp@jvnv.net>
Date: Sat, 19 Nov 2011 20:02:14 +0100
Subject: Moved driver related files to a subdirectory.

---
 drivers/gps.cpp | 40 ++++++++++++++++++++++++++++++++++++++++
 1 file changed, 40 insertions(+)
 create mode 100644 drivers/gps.cpp

(limited to 'drivers/gps.cpp')

diff --git a/drivers/gps.cpp b/drivers/gps.cpp
new file mode 100644
index 0000000..1ae3684
--- /dev/null
+++ b/drivers/gps.cpp
@@ -0,0 +1,40 @@
+#include "gps.h"
+
+GPS* GPS::self;
+
+template<>
+void interrupt<Interrupt::USART3>() {
+	GPS::self->irq();
+}
+
+void GPS::irq() {
+	
+	uint8_t c = USART3.DR;
+	
+	if(!incomplete_msg) {
+		incomplete_msg = msg_pool.create();
+		
+		if(!incomplete_msg) {
+			return;
+		}
+	}
+	
+	if(incomplete_msg->n == 0 && c != '$') {
+		return;
+	}
+	
+	if(incomplete_msg->n >= 128) {
+		incomplete_msg->n = 0;
+		return;
+	}
+	
+	incomplete_msg->buf[incomplete_msg->n++] = c;
+	
+	if(c == '\n') {
+		GPIOB.ODR ^= 1 << 1;
+		
+		const_cast<P<GPSMsg>&>(complete_msg) = incomplete_msg;
+		incomplete_msg.reset();
+		complete = true;
+	}
+}
-- 
cgit v1.2.3