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

   1 /*
   2  * Copyright © 2013 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; either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful, but
  10  * WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12  * General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along
  15  * with this program; if not, write to the Free Software Foundation, Inc.,
  16  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  17  */
  18
  19 package org.altusmetrum.altoslib_13;
  20
  21 import java.io.*;
  22 import java.util.*;
  23 import java.text.*;
  24
  25 class AltosTelemetryNullListener extends AltosDataListener {
  26         public void set_rssi(int rssi, int status) { }
  27         public void set_received_time(long received_time) { }
  28
  29         public void set_acceleration(double accel) { }
  30         public void set_pressure(double pa) { }
  31         public void set_thrust(double N) { }
  32
  33         public void set_kalman(double height, double speed, double accel) { }
  34
  35         public void set_temperature(double deg_c) { }
  36         public void set_battery_voltage(double volts) { }
  37
  38         public void set_apogee_voltage(double volts) { }
  39         public void set_main_voltage(double volts) { }
  40
  41         public void set_gps(AltosGPS gps) { }
  42
  43         public void set_orient(double orient) { }
  44         public void set_gyro(double roll, double pitch, double yaw) { }
  45         public void set_accel_ground(double along, double across, double through) { }
  46         public void set_accel(double along, double across, double through) { }
  47         public void set_mag(double along, double across, double through) { }
  48         public void set_pyro_voltage(double volts) { }
  49         public void set_igniter_voltage(double[] voltage) { }
  50         public void set_pyro_fired(int pyro_mask) { }
  51         public void set_companion(AltosCompanion companion) { }
  52
  53         public boolean cal_data_complete() {
  54                 /* All telemetry packets */
  55                 AltosCalData cal_data = cal_data();
  56
  57                 if (cal_data.serial == AltosLib.MISSING)
  58                         return false;
  59
  60                 if (cal_data.boost_tick == AltosLib.MISSING)
  61                         return false;
  62
  63                 /*
  64                  * TelemetryConfiguration:
  65                  *
  66                  * device_type, flight, config version, log max,
  67                  * flight params, callsign and version
  68                  */
  69                 if (cal_data.device_type == AltosLib.MISSING)
  70                         return false;
  71
  72                 /*
  73                  * TelemetrySensor or TelemetryMegaData:
  74                  *
  75                  * ground_accel, accel+/-, ground pressure
  76                  */
  77                 if (cal_data.ground_pressure == AltosLib.MISSING)
  78                         return false;
  79
  80                 /*
  81                  * TelemetryLocation
  82                  */
  83                 if (AltosLib.has_gps(cal_data.device_type) && cal_data.gps_pad == null)
  84                         return false;
  85
  86                 return true;
  87         }
  88
  89         public AltosTelemetryNullListener(AltosCalData cal_data) {
  90                 super(cal_data);
  91         }
  92 }
  93
  94 public class AltosTelemetryFile implements AltosRecordSet {
  95
  96         AltosTelemetryIterable  telems;
  97         AltosCalData            cal_data;
  98
  99         public void write_comments(PrintStream out) {
 100         }
 101
 102         public void write(PrintStream out) {
 103         }
 104
 105         /* Construct cal data by walking through the telemetry data until we've found everything available */
 106         public AltosCalData cal_data() {
 107                 if (cal_data == null) {
 108                         cal_data = new AltosCalData();
 109                         AltosTelemetryNullListener l = new AltosTelemetryNullListener(cal_data);
 110
 111                         for (AltosTelemetry telem : telems) {
 112                                 telem.provide_data(l);
 113                                 if (l.cal_data_complete())
 114                                         break;
 115                         }
 116                 }
 117                 return cal_data;
 118         }
 119
 120         public void capture_series(AltosDataListener listener) {
 121                 AltosCalData    cal_data = cal_data();
 122
 123                 cal_data.reset();
 124                 for (AltosTelemetry telem : telems) {
 125                         int tick = telem.tick();
 126                         cal_data.set_tick(tick);
 127
 128                         /* Try to pick up at least one pre-boost value */
 129                         if (cal_data.time() >= -2)
 130                                 telem.provide_data(listener);
 131                         if (listener.state() == AltosLib.ao_flight_landed)
 132                                 break;
 133                 }
 134                 listener.finish();
 135         }
 136
 137         public AltosTelemetryFile(FileInputStream input) throws IOException {
 138                 telems = new AltosTelemetryIterable(input);
 139         }
 140 }