From c4e983daa4579896b227fdcb2be43fad75e94307 Mon Sep 17 00:00:00 2001
From: Keith Packard <keithp@keithp.com>
Date: Sat, 18 Apr 2009 23:17:45 -0700
Subject: Parse GPS data locally. Add 'g' command to display recent GPS
 results.

This parses the GPS GGA message and stores it in a global variable,
protected by a mutex.
---
 ao_cmd.c | 32 ++++++++++++++++++++++++++++++++
 1 file changed, 32 insertions(+)

(limited to 'ao_cmd.c')

diff --git a/ao_cmd.c b/ao_cmd.c
index 575ed69a..6e91a72d 100644
--- a/ao_cmd.c
+++ b/ao_cmd.c
@@ -252,6 +252,34 @@ adc_dump(void)
 	put_string("\n");
 }
 
+static void
+gps_dump(void) __reentrant
+{
+	ao_mutex_get(&ao_gps_mutex);
+	if (ao_gps_data.flags & AO_GPS_VALID) {
+		printf("GPS %2d:%02d:%02d %2d°%2d.%04d'%c %2d°%2d.%04d'%c %5dm %2d sat\n",
+		       ao_gps_data.hour,
+		       ao_gps_data.minute,
+		       ao_gps_data.second,
+		       ao_gps_data.latitude.degrees,
+		       ao_gps_data.latitude.minutes,
+		       ao_gps_data.latitude.minutes_fraction,
+		       (ao_gps_data.flags & AO_GPS_LATITUDE_MASK) == AO_GPS_LATITUDE_NORTH ?
+		       'N' : 'S',
+		       ao_gps_data.longitude.degrees,
+		       ao_gps_data.longitude.minutes,
+		       ao_gps_data.longitude.minutes_fraction,
+		       (ao_gps_data.flags & AO_GPS_LONGITUDE_MASK) == AO_GPS_LONGITUDE_WEST ?
+		       'W' : 'E',
+		       ao_gps_data.altitude,
+		       (ao_gps_data.flags & AO_GPS_NUM_SAT_MASK) >> AO_GPS_NUM_SAT_SHIFT);
+	} else {
+		printf("GPS %2d sat\n",
+		       (ao_gps_data.flags & AO_GPS_NUM_SAT_MASK) >> AO_GPS_NUM_SAT_SHIFT);;
+	}
+	ao_mutex_put(&ao_gps_mutex);
+}
+
 static void
 dump(void)
 {
@@ -488,6 +516,7 @@ static const uint8_t help_txt[] =
 	"All numbers are in hex\n"
 	"?                                  Print this message\n"
 	"a                                  Display current ADC values\n"
+	"g                                  Display current GPS values\n"
 	"d <start> <end>                    Dump memory\n"
 	"e <block>                          Dump a block of EEPROM data\n"
 	"w <block> <start> <len> <data> ... Write data to EEPROM\n"
@@ -546,6 +575,9 @@ ao_cmd(void *parameters)
 		case 'a':
 			adc_dump();
 			break;
+		case 'g':
+			gps_dump();
+			break;
 		case 'e':
 			ee_dump();
 			break;
-- 
cgit v1.2.3