X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=ao-bringup%2Ftest-gps;fp=ao-bringup%2Ftest-gps;h=a1e216265ac33f1b1ec780be7ecec69243a25010;hp=0000000000000000000000000000000000000000;hb=9ab3a1de95b705783c31a7e16447f52c10b6b480;hpb=b40351d5cb9802133f443d4f5150958b03b9e8f0

diff --git a/ao-bringup/test-gps b/ao-bringup/test-gps
new file mode 100755
index 00000000..a1e21626
--- /dev/null
+++ b/ao-bringup/test-gps
@@ -0,0 +1,102 @@
+#!/usr/bin/nickle
+
+import File;
+
+string timed_read(file f, int timeout) {
+	thread reader = fork func() {
+		try {
+			return fgets(f);
+		} catch Thread::signal(int i) {
+			return "";
+		}
+	}();
+
+	thread killer = fork func() {
+		try {
+			sleep (timeout);
+			Thread::send_signal(reader, 1);
+		} catch Thread::signal(int i) {
+			return;
+		}
+	}();
+
+	poly v = Thread::join(reader);
+	Thread::send_signal(killer, 1);
+	Thread::join(killer);
+	if (is_string(v))
+		return v;
+	return "";
+}
+
+void flush_input(file f) {
+	for (;;) {
+		string s = timed_read(f, 200);
+		if (s == "")
+			break;
+	}
+}
+
+string[*] gps(file f) {
+	string[...] x = {};
+
+	flush_input(f);
+	fprintf (f, "g\nv\n");
+	flush(f);
+	for (;;) {
+		string l = timed_read(f, 1000);
+		if (l == "") {
+			File::fprintf(stderr, "Read timedout\n");
+			exit(1);
+		}
+		x[dim(x)] = l;
+		if (String::index(l, "software-version") == 0)
+			break;
+	}
+	return x;
+}
+
+string[*] find_gps(string[*] s, string match) {
+	for (int i = 0; i < dim(s); i++)
+		if (String::index(s[i], match) >= 0)
+			return String::wordsplit(s[i], " ");
+	return (string[*]) {};
+}
+
+bool
+do_gps(file f) {
+
+	string[*] i = gps(f);
+	string[*] flags = find_gps(i, "Flags:");
+	string[*] sats = find_gps(i, "Sats:");
+
+	int actual_flags = string_to_integer(flags[1]);
+
+	while ((actual_flags & (1 << 4)) == 0) {
+		printf("Flags: %s\n", flags[1]);
+		printf("Sats: %s\n", sats[1]);
+
+		sleep(1000);
+		i = gps(f);
+		flags = find_gps(i, "Flags:");
+		sats = find_gps(i, "Sats:");
+
+		actual_flags = string_to_integer(flags[1]);
+	}
+
+	printf("Flags: %s\n", flags[1]);
+	printf("Sats: %s\n", sats[1]);
+	printf("GPS locked\n");
+	return true;
+}
+
+void main () {
+	string	name = argv[1];
+	file	f = open(name, "r+");
+	bool ret = true;
+
+	if (!do_gps(f))
+		ret = false;
+	exit (ret? 0 : 1);
+}
+
+main();