1 files changed, 88 insertions, 0 deletions
diff --git a/altoslib/AltosTelemetryLocation.java b/altoslib/AltosTelemetryLocation.java
new file mode 100644
index 00000000..fa3c24d0
--- /dev/null
+++ b/altoslib/AltosTelemetryLocation.java
@@ -0,0 +1,88 @@
+/*
+ * Copyright © 2011 Keith Packard <keithp@keithp.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; version 2 of the License.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
+ */
+
+package org.altusmetrum.altoslib_1;
+
+
+public class AltosTelemetryLocation extends AltosTelemetryStandard {
+	int	flags;
+	int	altitude;
+	int	latitude;
+	int	longitude;
+	int	year;
+	int	month;
+	int	day;
+	int	hour;
+	int	minute;
+	int	second;
+	int	pdop;
+	int	hdop;
+	int	vdop;
+	int	mode;
+	int	ground_speed;
+	int	climb_rate;
+	int	course;
+
+	public AltosTelemetryLocation(int[] bytes) {
+		super(bytes);
+
+		flags          = uint8(5);
+		altitude       = int16(6);
+		latitude       = uint32(8);
+		longitude      = uint32(12);
+		year	       = uint8(16);
+		month	       = uint8(17);
+		day	       = uint8(18);
+		hour	       = uint8(19);
+		minute	       = uint8(20);
+		second	       = uint8(21);
+		pdop	       = uint8(22);
+		hdop	       = uint8(23);
+		vdop	       = uint8(24);
+		mode	       = uint8(25);
+		ground_speed   = uint16(26);
+		climb_rate     = int16(28);
+		course	       = uint8(30);
+	}
+
+	public void update_state(AltosState state) {
+		super.update_state(state);
+		AltosGPS	gps = state.make_temp_gps();
+
+		gps.nsat = flags & 0xf;
+		gps.locked = (flags & (1 << 4)) != 0;
+		gps.connected = (flags & (1 << 5)) != 0;
+
+		if (gps.locked) {
+			gps.lat = latitude * 1.0e-7;
+			gps.lon = longitude * 1.0e-7;
+			gps.alt = altitude;
+			gps.year = 2000 + year;
+			gps.month = month;
+			gps.day = day;
+			gps.hour = hour;
+			gps.minute = minute;
+			gps.second = second;
+			gps.ground_speed = ground_speed * 1.0e-2;
+			gps.course = course * 2;
+			gps.climb_rate = climb_rate * 1.0e-2;
+			gps.hdop = hdop;
+			gps.vdop = vdop;
+		}
+		state.set_temp_gps();
+	}
+}