import java.text.*;
public class AltosTelemetryIterable extends AltosRecordIterable {
- LinkedList<AltosRecord> records;
+ TreeSet<AltosRecord> records;
public Iterator<AltosRecord> iterator () {
return records.iterator();
int boost_tick = 0;
AltosRecord previous = null;
- records = new LinkedList<AltosRecord> ();
+ records = new TreeSet<AltosRecord> ();
try {
for (;;) {
AltosRecord record = AltosTelemetry.parse(line, previous);
if (record == null)
break;
- previous = record;
if (records.isEmpty()) {
current_tick = record.tick;
} else {
- int tick = record.tick | (current_tick & ~ 0xffff);
- if (tick < current_tick - 0x1000)
+ int tick = record.tick;
+ while (tick < current_tick - 0x1000)
tick += 0x10000;
current_tick = tick;
record.tick = current_tick;
has_gps = true;
if (record.main != AltosRecord.MISSING)
has_ignite = true;
- records.add(record);
+ if (previous != null && previous.tick != record.tick)
+ records.add(previous);
+ previous = record;
} catch (ParseException pe) {
System.out.printf("parse exception %s\n", pe.getMessage());
} catch (AltosCRCException ce) {
System.out.printf("io exception\n");
}
+ if (previous != null)
+ records.add(previous);
+
/* adjust all tick counts to be relative to boost time */
for (AltosRecord r : this)
r.time = (r.tick - boost_tick) / 100.0;