git.gag.com Git - fw/altos/blob - altosui/AltosTelemetry.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 altosui;
  19
  20 import java.lang.*;
  21 import java.text.*;
  22 import java.util.HashMap;
  23
  24 /*
  25  * Telemetry data contents
  26  */
  27
  28
  29 /*
  30  * The packet format is a simple hex dump of the raw telemetry frame.
  31  * It starts with 'TELEM', then contains hex digits with a checksum as the last
  32  * byte on the line.
  33  *
  34  * Version 4 is a replacement with consistent syntax. Each telemetry line
  35  * contains a sequence of space-separated names and values, the values are
  36  * either integers or strings. The names are all unique. All values are
  37  * optional
  38  *
  39  * VERSION 4 c KD7SQG n 236 f 18 r -25 s pad t 513 r_a 15756 r_b 26444 r_t 20944
  40  *   r_v 26640 r_d 512 r_m 208 c_a 15775 c_b 26439 c_p 15749 c_m 16281 a_a 15764
  41  *   a_s 0 a_b 26439 g_s u g_n 0 s_n 0
  42  *
  43  * VERSION 4 c KD7SQG n 19 f 0 r -23 s pad t 513 r_b 26372 r_t 21292 r_v 26788
  44  *   r_d 136 r_m 140 c_b 26370 k_h 0 k_s 0 k_a 0
  45  *
  46  * General header fields
  47  *
  48  *      Name            Value
  49  *
  50  *      VERSION         Telemetry version number (4 or more). Must be first.
  51  *      c               Callsign (string, no spaces allowed)
  52  *      n               Flight unit serial number (integer)
  53  *      f               Flight number (integer)
  54  *      r               Packet RSSI value (integer)
  55  *      s               Flight computer state (string, no spaces allowed)
  56  *      t               Flight computer clock (integer in centiseconds)
  57  *
  58  * Version 3 is Version 2 with fixed RSSI numbers -- the radio reports
  59  * in 1/2dB increments while this protocol provides only integers. So,
  60  * the syntax didn't change just the interpretation of the RSSI
  61  * values.
  62  *
  63  * Version 2 of the telemetry data stream is a bit of a mess, with no
  64  * consistent formatting. In particular, the GPS data is formatted for
  65  * viewing instead of parsing.  However, the key feature is that every
  66  * telemetry line contains all of the information necessary to
  67  * describe the current rocket state, including the calibration values
  68  * for accelerometer and barometer.
  69  *
  70  * GPS unlocked:
  71  *
  72  * VERSION 2 CALL KB0G SERIAL  51 FLIGHT     2 RSSI  -68 STATUS ff STATE     pad  1001 \
  73  *    a: 16032 p: 21232 t: 20284 v: 25160 d:   204 m:   204 fa: 16038 ga: 16032 fv:       0 \
  74  *    fp: 21232 gp: 21230 a+: 16049 a-: 16304 GPS  0 sat unlocked SAT 1   15  30
  75  *
  76  * GPS locked:
  77  *
  78  * VERSION 2 CALL KB0G SERIAL  51 FLIGHT     2 RSSI  -71 STATUS ff STATE     pad  2504 \
  79  *     a: 16028 p: 21220 t: 20360 v: 25004 d:   208 m:   200 fa: 16031 ga: 16032 fv:     330 \
  80  *     fp: 21231 gp: 21230 a+: 16049 a-: 16304 \
  81  *     GPS  9 sat 2010-02-13 17:16:51 35°20.0803'N 106°45.2235'W  1790m  \
  82  *     0.00m/s(H) 0°     0.00m/s(V) 1.0(hdop)     0(herr)     0(verr) \
  83  *     SAT 10   29  30  24  28   5  25  21  20  15  33   1  23  30  24  18  26  10  29   2  26
  84  *
  85  */
  86
  87 public class AltosTelemetry extends AltosRecord {
  88
  89         /*
  90          * General header fields
  91          *
  92          *      Name            Value
  93          *
  94          *      VERSION         Telemetry version number (4 or more). Must be first.
  95          *      c               Callsign (string, no spaces allowed)
  96          *      n               Flight unit serial number (integer)
  97          *      f               Flight number (integer)
  98          *      r               Packet RSSI value (integer)
  99          *      s               Flight computer state (string, no spaces allowed)
 100          *      t               Flight computer clock (integer in centiseconds)
 101          */
 102
 103         final static String AO_TELEM_VERSION    = "VERSION";
 104         final static String AO_TELEM_CALL       = "c";
 105         final static String AO_TELEM_SERIAL     = "n";
 106         final static String AO_TELEM_FLIGHT     = "f";
 107         final static String AO_TELEM_RSSI       = "r";
 108         final static String AO_TELEM_STATE      = "s";
 109         final static String AO_TELEM_TICK       = "t";
 110
 111         /*
 112          * Raw sensor values
 113          *
 114          *      Name            Value
 115          *      r_a             Accelerometer reading (integer)
 116          *      r_b             Barometer reading (integer)
 117          *      r_t             Thermometer reading (integer)
 118          *      r_v             Battery reading (integer)
 119          *      r_d             Drogue continuity (integer)
 120          *      r_m             Main continuity (integer)
 121          */
 122
 123         final static String AO_TELEM_RAW_ACCEL  = "r_a";
 124         final static String AO_TELEM_RAW_BARO   = "r_b";
 125         final static String AO_TELEM_RAW_THERMO = "r_t";
 126         final static String AO_TELEM_RAW_BATT   = "r_v";
 127         final static String AO_TELEM_RAW_DROGUE = "r_d";
 128         final static String AO_TELEM_RAW_MAIN   = "r_m";
 129
 130         /*
 131          * Sensor calibration values
 132          *
 133          *      Name            Value
 134          *      c_a             Ground accelerometer reading (integer)
 135          *      c_b             Ground barometer reading (integer)
 136          *      c_p             Accelerometer reading for +1g
 137          *      c_m             Accelerometer reading for -1g
 138          */
 139
 140         final static String AO_TELEM_CAL_ACCEL_GROUND   = "c_a";
 141         final static String AO_TELEM_CAL_BARO_GROUND    = "c_b";
 142         final static String AO_TELEM_CAL_ACCEL_PLUS     = "c_p";
 143         final static String AO_TELEM_CAL_ACCEL_MINUS    = "c_m";
 144
 145         /*
 146          * Kalman state values
 147          *
 148          *      Name            Value
 149          *      k_h             Height above pad (integer, meters)
 150          *      k_s             Vertical speeed (integer, m/s * 16)
 151          *      k_a             Vertical acceleration (integer, m/s² * 16)
 152          */
 153
 154         final static String AO_TELEM_KALMAN_HEIGHT      = "k_h";
 155         final static String AO_TELEM_KALMAN_SPEED       = "k_s";
 156         final static String AO_TELEM_KALMAN_ACCEL       = "k_a";
 157
 158         /*
 159          * Ad-hoc flight values
 160          *
 161          *      Name            Value
 162          *      a_a             Acceleration (integer, sensor units)
 163          *      a_s             Speed (integer, integrated acceleration value)
 164          *      a_b             Barometer reading (integer, sensor units)
 165          */
 166
 167         final static String AO_TELEM_ADHOC_ACCEL        = "a_a";
 168         final static String AO_TELEM_ADHOC_SPEED        = "a_s";
 169         final static String AO_TELEM_ADHOC_BARO         = "a_b";
 170
 171         /*
 172          * GPS values
 173          *
 174          *      Name            Value
 175          *      g_s             GPS state (string):
 176          *                              l       locked
 177          *                              u       unlocked
 178          *                              e       error (missing or broken)
 179          *      g_n             Number of sats used in solution
 180          *      g_ns            Latitude (degrees * 10e7)
 181          *      g_ew            Longitude (degrees * 10e7)
 182          *      g_a             Altitude (integer meters)
 183          *      g_Y             GPS year (integer)
 184          *      g_M             GPS month (integer - 1-12)
 185          *      g_D             GPS day (integer - 1-31)
 186          *      g_h             GPS hour (integer - 0-23)
 187          *      g_m             GPS minute (integer - 0-59)
 188          *      g_s             GPS second (integer - 0-59)
 189          *      g_v             GPS vertical speed (integer, cm/sec)
 190          *      g_s             GPS horizontal speed (integer, cm/sec)
 191          *      g_c             GPS course (integer, 0-359)
 192          *      g_hd            GPS hdop (integer * 10)
 193          *      g_vd            GPS vdop (integer * 10)
 194          *      g_he            GPS h error (integer)
 195          *      g_ve            GPS v error (integer)
 196          */
 197
 198         final static String AO_TELEM_GPS_STATE                  = "g";
 199         final static String AO_TELEM_GPS_STATE_LOCKED           = "l";
 200         final static String AO_TELEM_GPS_STATE_UNLOCKED         = "u";
 201         final static String AO_TELEM_GPS_STATE_ERROR            = "e";
 202         final static String AO_TELEM_GPS_NUM_SAT                = "g_n";
 203         final static String AO_TELEM_GPS_LATITUDE               = "g_ns";
 204         final static String AO_TELEM_GPS_LONGITUDE              = "g_ew";
 205         final static String AO_TELEM_GPS_ALTITUDE               = "g_a";
 206         final static String AO_TELEM_GPS_YEAR                   = "g_Y";
 207         final static String AO_TELEM_GPS_MONTH                  = "g_M";
 208         final static String AO_TELEM_GPS_DAY                    = "g_D";
 209         final static String AO_TELEM_GPS_HOUR                   = "g_h";
 210         final static String AO_TELEM_GPS_MINUTE                 = "g_m";
 211         final static String AO_TELEM_GPS_SECOND                 = "g_s";
 212         final static String AO_TELEM_GPS_VERTICAL_SPEED         = "g_v";
 213         final static String AO_TELEM_GPS_HORIZONTAL_SPEED       = "g_g";
 214         final static String AO_TELEM_GPS_COURSE                 = "g_c";
 215         final static String AO_TELEM_GPS_HDOP                   = "g_hd";
 216         final static String AO_TELEM_GPS_VDOP                   = "g_vd";
 217         final static String AO_TELEM_GPS_HERROR                 = "g_he";
 218         final static String AO_TELEM_GPS_VERROR                 = "g_ve";
 219
 220         /*
 221          * GPS satellite values
 222          *
 223          *      Name            Value
 224          *      s_n             Number of satellites reported (integer)
 225          *      s_v0            Space vehicle ID (integer) for report 0
 226          *      s_c0            C/N0 number (integer) for report 0
 227          *      s_v1            Space vehicle ID (integer) for report 1
 228          *      s_c1            C/N0 number (integer) for report 1
 229          *      ...
 230          */
 231
 232         final static String AO_TELEM_SAT_NUM    = "s_n";
 233         final static String AO_TELEM_SAT_SVID   = "s_v";
 234         final static String AO_TELEM_SAT_C_N_0  = "s_c";
 235
 236         static public AltosRecord parse(String line, AltosRecord previous) throws ParseException, AltosCRCException {
 237                 AltosTelemetryRecord    r = AltosTelemetryRecordGeneral.parse(line);
 238
 239                 return r.update_state(previous);
 240         }
 241 }