2 * Copyright © 2010 Keith Packard <keithp@keithp.com>
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.
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.
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.
22 import java.util.HashMap;
25 * Telemetry data contents
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
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
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
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
46 * General header fields
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)
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
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.
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
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
87 public class AltosTelemetry extends AltosRecord {
90 * General header fields
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)
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";
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)
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";
131 * Sensor calibration values
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
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";
146 * Kalman state values
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)
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";
159 * Ad-hoc flight values
162 * a_a Acceleration (integer, sensor units)
163 * a_s Speed (integer, integrated acceleration value)
164 * a_b Barometer reading (integer, sensor units)
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";
175 * g_s GPS state (string):
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)
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";
221 * GPS satellite values
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
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";
236 static public AltosRecord parse(String line, AltosRecord previous) throws ParseException, AltosCRCException {
237 AltosTelemetryRecord r = AltosTelemetryRecordGeneral.parse(line);
239 return r.update_state(previous);