X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=altoslib%2FAltosTelemetryIterable.java;h=8075b8a3274cf6f1706de1719661492c89532ed3;hb=effc62354fc82bb937c6f445a147fc92153a0731;hp=e95c15e0b5026438a8f856ff3ff18b5d0cffd596;hpb=6f421818fd7062f03bfaf9e606d6a4cfdcb13b49;p=fw%2Faltos

diff --git a/altoslib/AltosTelemetryIterable.java b/altoslib/AltosTelemetryIterable.java
index e95c15e0..8075b8a3 100644
--- a/altoslib/AltosTelemetryIterable.java
+++ b/altoslib/AltosTelemetryIterable.java
@@ -15,33 +15,82 @@
  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  */
 
-package org.altusmetrum.AltosLib;
+package org.altusmetrum.altoslib_2;
 
 import java.io.*;
 import java.util.*;
 import java.text.*;
 
-public class AltosTelemetryIterable extends AltosRecordIterable {
-	TreeSet<AltosRecord>	records;
+class AltosTelemetryOrdered implements Comparable<AltosTelemetryOrdered> {
+	AltosTelemetry	telem;
+	int		index;
+	int		tick;
 
-	public Iterator<AltosRecord> iterator () {
-		return records.iterator();
+	public int compareTo(AltosTelemetryOrdered o) {
+		int	tick_diff = tick - o.tick;
+
+		if (tick_diff != 0)
+			return tick_diff;
+		return index - o.index;
 	}
 
-	boolean has_gps = false;
-	boolean has_accel = false;
-	boolean has_ignite = false;
-	public boolean has_gps() { return has_gps; }
-	public boolean has_accel() { return has_accel; }
-	public boolean has_ignite() { return has_ignite; };
+	AltosTelemetryOrdered (AltosTelemetry telem, int index, int tick) {
+		this.telem = telem;
+		this.index = index;
+		this.tick = tick;
+	}
+}
 
-	public AltosTelemetryIterable (FileInputStream input) {
-		boolean saw_boost = false;
-		int	current_tick = 0;
-		int	boost_tick = 0;
+class AltosTelemetryOrderedIterator implements Iterator<AltosTelemetry> {
+	TreeSet<AltosTelemetryOrdered>	olist;
+	Iterator<AltosTelemetryOrdered>	oiterator;
 
-		AltosRecord	previous = null;
-		records = new TreeSet<AltosRecord> ();
+	public AltosTelemetryOrderedIterator(Iterable<AltosTelemetry> telems) {
+		olist = new TreeSet<AltosTelemetryOrdered>();
+
+		int	tick = 0;
+		int	index = 0;
+		boolean	first = true;
+
+		for (AltosTelemetry e : telems) {
+			int	t = e.tick;
+			if (first)
+				tick = t;
+			else {
+				while (t < tick - 32767)
+					t += 65536;
+				tick = t;
+			}
+			olist.add(new AltosTelemetryOrdered(e, index++, tick));
+			first = false;
+		}
+
+		oiterator = olist.iterator();
+	}
+
+	public boolean hasNext() {
+		return oiterator.hasNext();
+	}
+
+	public AltosTelemetry next() {
+		return oiterator.next().telem;
+	}
+
+	public void remove () {
+	}
+}
+
+public class AltosTelemetryIterable implements Iterable<AltosTelemetry> {
+	LinkedList<AltosTelemetry>	telems;
+
+	public Iterator<AltosTelemetry> iterator () {
+		if (telems == null)
+			telems = new LinkedList<AltosTelemetry>();
+		return new AltosTelemetryOrderedIterator(telems);
+	}
+
+	public AltosTelemetryIterable (FileInputStream input) {
+		telems = new LinkedList<AltosTelemetry> ();
 
 		try {
 			for (;;) {
@@ -50,32 +99,10 @@ public class AltosTelemetryIterable extends AltosRecordIterable {
 					break;
 				}
 				try {
-					AltosRecord record = AltosTelemetry.parse(line, previous);
-					if (record == null)
+					AltosTelemetry telem = AltosTelemetry.parse(line);
+					if (telem == null)
 						break;
-					if (records.isEmpty()) {
-						current_tick = record.tick;
-					} else {
-						int tick = record.tick;
-						while (tick < current_tick - 0x1000)
-							tick += 0x10000;
-						current_tick = tick;
-						record.tick = current_tick;
-					}
-					if (!saw_boost && record.state >= AltosLib.ao_flight_boost)
-					{
-						saw_boost = true;
-						boost_tick = record.tick;
-					}
-					if (record.acceleration() != AltosRecord.MISSING)
-						has_accel = true;
-					if (record.gps != null)
-						has_gps = true;
-					if (record.main_voltage() != AltosRecord.MISSING)
-						has_ignite = true;
-					if (previous != null && previous.tick != record.tick)
-						records.add(previous);
-					previous = record;
+					telems.add(telem);
 				} catch (ParseException pe) {
 					System.out.printf("parse exception %s\n", pe.getMessage());
 				} catch (AltosCRCException ce) {
@@ -84,26 +111,5 @@ public class AltosTelemetryIterable extends AltosRecordIterable {
 		} catch (IOException io) {
 			System.out.printf("io exception\n");
 		}
-
-		if (previous != null)
-			records.add(previous);
-
-		/* Adjust all tick counts to match expected eeprom values,
-		 * which starts with a 16-bit tick count 16 samples before boost
-		 */
-
-		int tick_adjust = (boost_tick - 16) & 0xffff0000;
-		for (AltosRecord r : this)
-			r.tick -= tick_adjust;
-		boost_tick -= tick_adjust;
-
-		/* adjust all tick counts to be relative to boost time */
-		for (AltosRecord r : this)
-			r.time = (r.tick - boost_tick) / 100.0;
-
-		try {
-			input.close();
-		} catch (IOException ie) {
-		}
 	}
 }