git.gag.com Git - fw/altos/blob - ao-tools/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 import altosui.AltosConvert;
  24 import altosui.AltosRecord;
  25 import altosui.AltosGPS;
  26
  27 /*
  28  * Telemetry data contents
  29  */
  30
  31
  32 /*
  33  * The telemetry data stream is a bit of a mess at present, with no consistent
  34  * formatting. In particular, the GPS data is formatted for viewing instead of parsing.
  35  * However, the key feature is that every telemetry line contains all of the information
  36  * necessary to describe the current rocket state, including the calibration values
  37  * for accelerometer and barometer.
  38  *
  39  * GPS unlocked:
  40  *
  41  * VERSION 2 CALL KB0G SERIAL  51 FLIGHT     2 RSSI  -68 STATUS ff STATE     pad  1001 \
  42  *    a: 16032 p: 21232 t: 20284 v: 25160 d:   204 m:   204 fa: 16038 ga: 16032 fv:       0 \
  43  *    fp: 21232 gp: 21230 a+: 16049 a-: 16304 GPS  0 sat unlocked SAT 1   15  30
  44  *
  45  * GPS locked:
  46  *
  47  * VERSION 2 CALL KB0G SERIAL  51 FLIGHT     2 RSSI  -71 STATUS ff STATE     pad  2504 \
  48  *     a: 16028 p: 21220 t: 20360 v: 25004 d:   208 m:   200 fa: 16031 ga: 16032 fv:     330 \
  49  *     fp: 21231 gp: 21230 a+: 16049 a-: 16304 \
  50  *     GPS  9 sat 2010-02-13 17:16:51 35°20.0803'N 106°45.2235'W  1790m  \
  51  *     0.00m/s(H) 0°     0.00m/s(V) 1.0(hdop)     0(herr)     0(verr) \
  52  *     SAT 10   29  30  24  28   5  25  21  20  15  33   1  23  30  24  18  26  10  29   2  26
  53  */
  54
  55 public class AltosTelemetry extends AltosRecord {
  56         public AltosTelemetry(String line) throws ParseException {
  57                 String[] words = line.split("\\s+");
  58                 int     i = 0;
  59
  60                 AltosParse.word (words[i++], "VERSION");
  61                 version = AltosParse.parse_int(words[i++]);
  62
  63                 AltosParse.word (words[i++], "CALL");
  64                 callsign = words[i++];
  65
  66                 AltosParse.word (words[i++], "SERIAL");
  67                 serial = AltosParse.parse_int(words[i++]);
  68
  69                 AltosParse.word (words[i++], "FLIGHT");
  70                 flight = AltosParse.parse_int(words[i++]);
  71
  72                 AltosParse.word(words[i++], "RSSI");
  73                 rssi = AltosParse.parse_int(words[i++]);
  74
  75                 AltosParse.word(words[i++], "STATUS");
  76                 status = AltosParse.parse_hex(words[i++]);
  77
  78                 AltosParse.word(words[i++], "STATE");
  79                 state = Altos.state(words[i++]);
  80
  81                 tick = AltosParse.parse_int(words[i++]);
  82
  83                 AltosParse.word(words[i++], "a:");
  84                 accel = AltosParse.parse_int(words[i++]);
  85
  86                 AltosParse.word(words[i++], "p:");
  87                 pres = AltosParse.parse_int(words[i++]);
  88
  89                 AltosParse.word(words[i++], "t:");
  90                 temp = AltosParse.parse_int(words[i++]);
  91
  92                 AltosParse.word(words[i++], "v:");
  93                 batt = AltosParse.parse_int(words[i++]);
  94
  95                 AltosParse.word(words[i++], "d:");
  96                 drogue = AltosParse.parse_int(words[i++]);
  97
  98                 AltosParse.word(words[i++], "m:");
  99                 main = AltosParse.parse_int(words[i++]);
 100
 101                 AltosParse.word(words[i++], "fa:");
 102                 flight_accel = AltosParse.parse_int(words[i++]);
 103
 104                 AltosParse.word(words[i++], "ga:");
 105                 ground_accel = AltosParse.parse_int(words[i++]);
 106
 107                 AltosParse.word(words[i++], "fv:");
 108                 flight_vel = AltosParse.parse_int(words[i++]);
 109
 110                 AltosParse.word(words[i++], "fp:");
 111                 flight_pres = AltosParse.parse_int(words[i++]);
 112
 113                 AltosParse.word(words[i++], "gp:");
 114                 ground_pres = AltosParse.parse_int(words[i++]);
 115
 116                 AltosParse.word(words[i++], "a+:");
 117                 accel_plus_g = AltosParse.parse_int(words[i++]);
 118
 119                 AltosParse.word(words[i++], "a-:");
 120                 accel_minus_g = AltosParse.parse_int(words[i++]);
 121
 122                 gps = new AltosGPS(words, i);
 123         }
 124 }