X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=ao-view%2Faoview_monitor.c;h=8564014b31c7a9f7e4703891d526aab721f7450d;hb=591b99c232e780246fc07841c09c8c4e7835facb;hp=9265a1992ac439294dbec034e1b0b2ca0a204b84;hpb=9789ca5e8caa9a013e804f307b9da380e147bd75;p=fw%2Faltos

diff --git a/ao-view/aoview_monitor.c b/ao-view/aoview_monitor.c
index 9265a199..8564014b 100644
--- a/ao-view/aoview_monitor.c
+++ b/ao-view/aoview_monitor.c
@@ -47,6 +47,12 @@ aoview_parse_int(int *target, char *source)
 	*target = strtol(source, NULL, 0);
 }
 
+static void
+aoview_parse_hex(int *target, char *source)
+{
+	*target = strtol(source, NULL, 16);
+}
+
 static void
 aoview_parse_pos(double *target, char *source)
 {
@@ -65,20 +71,23 @@ aoview_parse_pos(double *target, char *source)
 	*target = r;
 }
 
+#define PARSE_MAX_WORDS	256
+
 gboolean
 aoview_monitor_parse(const char *input_line)
 {
 	char *saveptr;
-	char *words[64];
+	char *words[PARSE_MAX_WORDS];
 	int nword;
 	char line_buf[8192], *line;
 	struct aodata	data;
+	int	tracking_pos;
 
 	/* avoid smashing our input parameter */
 	strncpy (line_buf, input_line, sizeof (line_buf)-1);
 	line_buf[sizeof(line_buf) - 1] = '\0';
 	line = line_buf;
-	for (nword = 0; nword < 64; nword++) {
+	for (nword = 0; nword < PARSE_MAX_WORDS; nword++) {
 		words[nword] = strtok_r(line, " \t\n", &saveptr);
 		line = NULL;
 		if (words[nword] == NULL)
@@ -112,6 +121,7 @@ aoview_monitor_parse(const char *input_line)
 		data.gps.gps_time.hour = data.gps.gps_time.minute = data.gps.gps_time.second = 0;
 		data.gps.lat = data.gps.lon = 0;
 		data.gps.alt = 0;
+		tracking_pos = 37;
 	} else if (nword >= 40) {
 		data.gps.gps_locked = 1;
 		data.gps.gps_connected = 1;
@@ -119,12 +129,14 @@ aoview_monitor_parse(const char *input_line)
 		aoview_parse_pos(&data.gps.lat, words[37]);
 		aoview_parse_pos(&data.gps.lon, words[38]);
 		sscanf(words[39], "%dm", &data.gps.alt);
+		tracking_pos = 46;
 	} else {
 		data.gps.gps_connected = 0;
 		data.gps.gps_locked = 0;
 		data.gps.gps_time.hour = data.gps.gps_time.minute = data.gps.gps_time.second = 0;
 		data.gps.lat = data.gps.lon = 0;
 		data.gps.alt = 0;
+		tracking_pos = -1;
 	}
 	if (nword >= 46) {
 		data.gps.gps_extended = 1;
@@ -143,6 +155,27 @@ aoview_monitor_parse(const char *input_line)
 		data.gps.h_error = 0;
 		data.gps.v_error = 0;
 	}
+	if (tracking_pos >= 0 && nword >= tracking_pos + 2 && strcmp(words[tracking_pos], "SAT") == 0) {
+		int	c, n, pos;
+		aoview_parse_int(&n, words[tracking_pos + 1]);
+		pos = tracking_pos + 2;
+		if (nword >= pos + n * 3) {
+			data.gps_tracking.channels = n;
+			for (c = 0; c < n; c++) {
+				aoview_parse_int(&data.gps_tracking.sats[c].svid,
+						 words[pos + 0]);
+				aoview_parse_hex(&data.gps_tracking.sats[c].state,
+						 words[pos + 1]);
+				aoview_parse_int(&data.gps_tracking.sats[c].c_n0,
+						 words[pos + 2]);
+				pos += 3;
+			}
+		} else {
+			data.gps_tracking.channels = 0;
+		}
+	} else {
+		data.gps_tracking.channels = 0;
+	}
 	aoview_state_notify(&data);
 	return TRUE;
 }