From 524665fc221b0d483453c67b7211e282cebc8980 Mon Sep 17 00:00:00 2001
From: Keith Packard <keithp@keithp.com>
Date: Sun, 15 Nov 2009 16:04:41 -0800
Subject: Add date to GPS data, captured from GPRMC packet.

Pull the date out of the GPS stream and send it over the telemetry
link and write it to the eeprom.

Signed-off-by: Keith Packard <keithp@keithp.com>
---
 ao-tools/lib/cc-telem.c | 12 ++++++++++++
 ao-tools/lib/cc.h       |  3 +++
 2 files changed, 15 insertions(+)

(limited to 'ao-tools/lib')

diff --git a/ao-tools/lib/cc-telem.c b/ao-tools/lib/cc-telem.c
index 0e1483f7..9a2f6155 100644
--- a/ao-tools/lib/cc-telem.c
+++ b/ao-tools/lib/cc-telem.c
@@ -127,6 +127,7 @@ cc_telem_parse(const char *input_line, struct cc_telem *telem)
 	if (strcmp (words[36], "unlocked") == 0) {
 		telem->gps.gps_connected = 1;
 		telem->gps.gps_locked = 0;
+		telem->gps.gps_time.year = telem->gps.gps_time.month = telem->gps.gps_time.day = 0;
 		telem->gps.gps_time.hour = telem->gps.gps_time.minute = telem->gps.gps_time.second = 0;
 		telem->gps.lat = telem->gps.lon = 0;
 		telem->gps.alt = 0;
@@ -134,6 +135,16 @@ cc_telem_parse(const char *input_line, struct cc_telem *telem)
 	} else if (nword >= 40) {
 		telem->gps.gps_locked = 1;
 		telem->gps.gps_connected = 1;
+		if (version >= 2) {
+			sscanf(words[36], "%d-%d-%d",
+			       &telem->gps.gps_time.year,
+			       &telem->gps.gps_time.month,
+			       &telem->gps.gps_time.day);
+			words += 1;
+			nword -= 1;
+		} else {
+			telem->gps.gps_time.year = telem->gps.gps_time.month = telem->gps.gps_time.day = 0;
+		}
 		sscanf(words[36], "%d:%d:%d", &telem->gps.gps_time.hour, &telem->gps.gps_time.minute, &telem->gps.gps_time.second);
 		cc_parse_pos(&telem->gps.lat, words[37]);
 		cc_parse_pos(&telem->gps.lon, words[38]);
@@ -142,6 +153,7 @@ cc_telem_parse(const char *input_line, struct cc_telem *telem)
 	} else {
 		telem->gps.gps_connected = 0;
 		telem->gps.gps_locked = 0;
+		telem->gps.gps_time.year = telem->gps.gps_time.month = telem->gps.gps_time.day = 0;
 		telem->gps.gps_time.hour = telem->gps.gps_time.minute = telem->gps.gps_time.second = 0;
 		telem->gps.lat = telem->gps.lon = 0;
 		telem->gps.alt = 0;
diff --git a/ao-tools/lib/cc.h b/ao-tools/lib/cc.h
index b8e3c061..ebc0db7d 100644
--- a/ao-tools/lib/cc.h
+++ b/ao-tools/lib/cc.h
@@ -192,6 +192,9 @@ struct cc_flightcooked {
 
 
 struct cc_gps_time {
+	int year;
+	int month;
+	int day;
 	int hour;
 	int minute;
 	int second;
-- 
cgit v1.2.3