git.gag.com Git - fw/altos/blob - altoslib/AltosTelemetryIterable.java

   1 /*
   2  * Copyright © 2010 Keith Packard <keithp@keithp.com>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; version 2 of the License.
   7  *
   8  * This program is distributed in the hope that it will be useful, but
   9  * WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  11  * General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License along
  14  * with this program; if not, write to the Free Software Foundation, Inc.,
  15  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  16  */
  17
  18 package org.altusmetrum.altoslib_10;
  19
  20 import java.io.*;
  21 import java.util.*;
  22 import java.text.*;
  23
  24 class AltosTelemetryOrdered implements Comparable<AltosTelemetryOrdered> {
  25         AltosTelemetry  telem;
  26         int             index;
  27         int             tick;
  28
  29         public int compareTo(AltosTelemetryOrdered o) {
  30                 int     tick_diff = tick - o.tick;
  31
  32                 if (tick_diff != 0)
  33                         return tick_diff;
  34                 return index - o.index;
  35         }
  36
  37         AltosTelemetryOrdered (AltosTelemetry telem, int index, int tick) {
  38                 this.telem = telem;
  39                 this.index = index;
  40                 this.tick = tick;
  41         }
  42 }
  43
  44 class AltosTelemetryOrderedIterator implements Iterator<AltosTelemetry> {
  45         Iterator<AltosTelemetryOrdered> iterator;
  46
  47         public AltosTelemetryOrderedIterator(TreeSet<AltosTelemetryOrdered> telems) {
  48                 iterator = telems.iterator();
  49         }
  50
  51         public boolean hasNext() {
  52                 return iterator.hasNext();
  53         }
  54
  55         public AltosTelemetry next() {
  56                 return iterator.next().telem;
  57         }
  58
  59         public void remove () {
  60         }
  61 }
  62
  63 public class AltosTelemetryIterable implements Iterable<AltosTelemetry> {
  64         TreeSet<AltosTelemetryOrdered>  telems;
  65         int tick;
  66         int index;
  67
  68         public void add (AltosTelemetry telem) {
  69                 int     t = telem.tick;
  70                 if (!telems.isEmpty()) {
  71                         while (t < tick - 1000)
  72                                 t += 65536;
  73                 }
  74                 tick = t;
  75                 telems.add(new AltosTelemetryOrdered(telem, index++, tick));
  76         }
  77
  78         public Iterator<AltosTelemetry> iterator () {
  79                 return new AltosTelemetryOrderedIterator(telems);
  80         }
  81
  82         public AltosTelemetryIterable (FileInputStream input) {
  83                 telems = new TreeSet<AltosTelemetryOrdered> ();
  84                 tick = 0;
  85                 index = 0;
  86
  87                 try {
  88                         for (;;) {
  89                                 String line = AltosLib.gets(input);
  90                                 if (line == null) {
  91                                         break;
  92                                 }
  93                                 try {
  94                                         AltosTelemetry telem = AltosTelemetry.parse(line);
  95                                         if (telem == null)
  96                                                 break;
  97                                         add(telem);
  98                                 } catch (ParseException pe) {
  99                                         System.out.printf("parse exception %s\n", pe.getMessage());
 100                                 } catch (AltosCRCException ce) {
 101                                 }
 102                         }
 103                 } catch (IOException io) {
 104                         System.out.printf("io exception\n");
 105                 }
 106         }
 107 }