X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=altoslib%2FAltosTelemetryMegaData.java;fp=altoslib%2FAltosTelemetryMegaData.java;h=8b1869bb65f3141fdc83a74496b97fdaa3fb0995;hp=93610118311cf841b68bebe6026dc9e2fc14c933;hb=59702e5ff8d0522b0aa9dcca863309eaafbcda09;hpb=6dc58c63d202e918f16d5fbe9b188d422edcdd9c

diff --git a/altoslib/AltosTelemetryMegaData.java b/altoslib/AltosTelemetryMegaData.java
index 93610118..8b1869bb 100644
--- a/altoslib/AltosTelemetryMegaData.java
+++ b/altoslib/AltosTelemetryMegaData.java
@@ -31,7 +31,7 @@ public class AltosTelemetryMegaData extends AltosTelemetryStandard {
 
 	int	acceleration;
 	int	speed;
-	int	height;
+	int	height_16;
 
 	public AltosTelemetryMegaData(int[] bytes) {
 		super(bytes);
@@ -55,7 +55,8 @@ public class AltosTelemetryMegaData extends AltosTelemetryStandard {
 
 		acceleration = int16(26);
 		speed = int16(28);
-		height = int16(30);
+
+		height_16 = int16(30);
 	}
 
 	public void update_state(AltosState state) {
@@ -79,7 +80,13 @@ public class AltosTelemetryMegaData extends AltosTelemetryStandard {
 		state.set_ground_pressure(ground_pres);
 		state.set_accel_g(accel_plus_g, accel_minus_g);
 
-		state.set_kalman(height, speed/16.0, acceleration / 16.0);
+		/* Fill in the high bits of height from recent GPS
+		 * data if available, otherwise guess using the
+		 * previous kalman height
+		 */
+
+		state.set_kalman(extend_height(state, height_16),
+				 speed/16.0, acceleration / 16.0);
 	}
 }