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_2;
  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         TreeSet<AltosTelemetryOrdered>  olist;
  46         Iterator<AltosTelemetryOrdered> oiterator;
  47
  48         public AltosTelemetryOrderedIterator(Iterable<AltosTelemetry> telems) {
  49                 olist = new TreeSet<AltosTelemetryOrdered>();
  50
  51                 int     tick = 0;
  52                 int     index = 0;
  53                 boolean first = true;
  54
  55                 for (AltosTelemetry e : telems) {
  56                         int     t = e.tick;
  57                         if (first)
  58                                 tick = t;
  59                         else {
  60                                 while (t < tick - 32767)
  61                                         t += 65536;
  62                                 tick = t;
  63                         }
  64                         olist.add(new AltosTelemetryOrdered(e, index++, tick));
  65                         first = false;
  66                 }
  67
  68                 oiterator = olist.iterator();
  69         }
  70
  71         public boolean hasNext() {
  72                 return oiterator.hasNext();
  73         }
  74
  75         public AltosTelemetry next() {
  76                 return oiterator.next().telem;
  77         }
  78
  79         public void remove () {
  80         }
  81 }
  82
  83 public class AltosTelemetryIterable implements Iterable<AltosTelemetry> {
  84         LinkedList<AltosTelemetry>      telems;
  85
  86         public Iterator<AltosTelemetry> iterator () {
  87                 if (telems == null)
  88                         telems = new LinkedList<AltosTelemetry>();
  89                 return new AltosTelemetryOrderedIterator(telems);
  90         }
  91
  92         public AltosTelemetryIterable (FileInputStream input) {
  93                 telems = new LinkedList<AltosTelemetry> ();
  94
  95                 try {
  96                         for (;;) {
  97                                 String line = AltosLib.gets(input);
  98                                 if (line == null) {
  99                                         break;
 100                                 }
 101                                 try {
 102                                         AltosTelemetry telem = AltosTelemetry.parse(line);
 103                                         if (telem == null)
 104                                                 break;
 105                                         telems.add(telem);
 106                                 } catch (ParseException pe) {
 107                                         System.out.printf("parse exception %s\n", pe.getMessage());
 108                                 } catch (AltosCRCException ce) {
 109                                 }
 110                         }
 111                 } catch (IOException io) {
 112                         System.out.printf("io exception\n");
 113                 }
 114         }
 115 }