diff options
Diffstat (limited to 'altosui/AltosTelemetryIterable.java')
| -rw-r--r-- | altosui/AltosTelemetryIterable.java | 82 | 
1 files changed, 82 insertions, 0 deletions
diff --git a/altosui/AltosTelemetryIterable.java b/altosui/AltosTelemetryIterable.java new file mode 100644 index 00000000..a71ab872 --- /dev/null +++ b/altosui/AltosTelemetryIterable.java @@ -0,0 +1,82 @@ +/* + * Copyright © 2010 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 altosui; + +import java.io.*; +import java.util.*; +import java.text.*; + +public class AltosTelemetryIterable extends AltosRecordIterable { +	LinkedList<AltosRecord>	records; + +	public Iterator<AltosRecord> iterator () { +		return records.iterator(); +	} + +	public AltosTelemetryIterable (FileInputStream input) { +		boolean saw_boost = false; +		int	current_tick = 0; +		int	boost_tick = 0; + +		records = new LinkedList<AltosRecord> (); + +		try { +			for (;;) { +				String line = AltosRecord.gets(input); +				if (line == null) { +					break; +				} +				try { +					AltosTelemetry record = new AltosTelemetry(line); +					if (record == null) +						break; +					if (records.isEmpty()) { +						current_tick = record.tick; +					} else { +						int tick = record.tick | (current_tick & ~ 0xffff); +						if (tick < current_tick - 0x1000) +							tick += 0x10000; +						current_tick = tick; +						record.tick = current_tick; +					} +					if (!saw_boost && record.state >= Altos.ao_flight_boost) +					{ +						saw_boost = true; +						boost_tick = record.tick; +					} +					records.add(record); +				} catch (ParseException pe) { +					System.out.printf("parse exception %s\n", pe.getMessage()); +				} catch (AltosCRCException ce) { +					System.out.printf("crc error\n"); +				} +			} +		} catch (IOException io) { +			System.out.printf("io exception\n"); +		} + +		/* 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) { +		} +	} +}  | 
