ao-eeprom: Add easy motor support
[fw/altos] / ao-tools / ao-eeprom / ao-eeprom.c
1 /*
2  * Copyright © 2009 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 #include <stdio.h>
20 #include <stdlib.h>
21 #include <stdbool.h>
22 #include <unistd.h>
23 #include <getopt.h>
24 #include <ao-eeprom-read.h>
25 #include <ao-atmosphere.h>
26
27 static const struct option options[] = {
28         { .name = "raw", .has_arg = 0, .val = 'r' },
29         { .name = "csum", .has_arg = 0, .val = 'c' },
30         { .name = "verbose", .has_arg = 0, .val = 'v' },
31         { .name = "len", .has_arg = 1, .val = 'l' },
32         { 0, 0, 0, 0},
33 };
34
35 static void usage(char *program)
36 {
37         fprintf(stderr, "usage: %s [--raw] [--csum] [--verbose] [--len <record-len>] {flight.eeprom} ...\n", program);
38         exit(1);
39 }
40
41 static bool
42 ao_csum_valid(uint8_t *d, int len)
43 {
44         uint8_t sum = 0x5a;
45         int i;
46         for (i = 0; i < len; i++)
47                 sum += d[i];
48         return sum == 0;
49 }
50
51 static void
52 ao_ms5607(uint32_t pres, uint32_t temp, struct ao_eeprom *eeprom, bool is_ms5611)
53 {
54         struct ao_ms5607_sample ms5607_sample = { .pres = pres, .temp = temp };
55         struct ao_ms5607_value ms5607_value;
56
57         ao_ms5607_convert(&ms5607_sample, &ms5607_value,
58                           &eeprom->ms5607_prom, is_ms5611);
59         printf(" pres %9u %7.3f kPa  %7.1f m temp %9u %6.2f °C",
60                pres,
61                ms5607_value.pres / 1000.0,
62                ao_pressure_to_altitude(ms5607_value.pres),
63                temp,
64                ms5607_value.temp / 100.0);
65 }
66
67 #define GRAVITY 9.80665
68
69 static void
70 ao_accel(int16_t accel, struct ao_eeprom *eeprom)
71 {
72         double accel_2g = eeprom->config.accel_minus_g - eeprom->config.accel_plus_g;
73         double accel_scale = GRAVITY * 2.0 / accel_2g;
74         printf(" accel %6d %7.2f m/s²",
75                accel, (eeprom->config.accel_plus_g - accel) * accel_scale);
76 }
77
78 static const char *state_names[] = {
79         "startup",
80         "idle",
81         "pad",
82         "boost",
83         "fast",
84         "coast",
85         "drogue",
86         "main",
87         "landed",
88         "invalid"
89 };
90
91 #define NUM_STATE       (sizeof state_names/sizeof state_names[0])
92
93 static const char *
94 ao_state_name(uint16_t state)
95 {
96         if (state < NUM_STATE)
97                 return state_names[state];
98         return "UNKNOWN";
99 }
100
101 static void
102 ao_state(uint16_t state, uint16_t reason)
103 {
104         printf(" state %5u %s reason %5u",
105                state, ao_state_name(state), reason);
106 }
107
108 static double
109 ao_adc_to_volts(int16_t value, int16_t max_adc, double ref, double r1, double r2)
110 {
111         return ref * ((double) value / max_adc) * (r1 + r2) / r2;
112 }
113
114 static void
115 ao_volts(const char *name, int16_t value, int16_t max_adc, double ref, double r1, double r2)
116 {
117         printf(" %s %5d",
118                name, value);
119         if (r1 && r2 && ref)
120                 printf(" %6.3f V", ao_adc_to_volts(value, max_adc, ref, r1, r2));
121 }
122
123 static double lb_to_n(double lb)
124 {
125         return lb / 0.22480894;
126 }
127
128 static double psi_to_pa(double psi)
129 {
130         return psi * 6894.76;
131 }
132
133 static double
134 ao_volts_to_newtons(double volts)
135 {
136         /* this is a total guess */
137         return lb_to_n(volts * 57.88645 * GRAVITY);
138 }
139
140 static void
141 ao_thrust(int16_t value, int16_t max_adc, double ref, double r1, double r2)
142 {
143         printf(" thrust %5d", value);
144         if (r1 && r2 && ref) {
145                 double volts = ao_adc_to_volts(value, max_adc, ref, r1, r2);
146                 printf(" %6.3f V %8.1f N", volts, ao_volts_to_newtons(volts));
147         }
148 }
149
150 static void
151 ao_pressure(int16_t value, int16_t max_adc, double ref, double r1, double r2, double sensor_range)
152 {
153         printf(" pressure %5d", value);
154         if (r1 && r2 && ref) {
155                 double volts = ao_adc_to_volts(value, max_adc, ref, r1, r2);
156                 if (volts < 0.5) volts = 0.5;
157                 if (volts > 4.5) volts = 4.5;
158
159                 double psi = (volts - 0.5) / 4.0 * sensor_range;
160                 double pa = psi_to_pa(psi);
161                 printf(" %9.3f kPa", pa / 1000.0);
162         }
163 }
164
165 #if 0
166 static uint16_t
167 uint16(uint8_t *bytes, int off)
168 {
169         return (uint16_t) bytes[off] | (((uint16_t) bytes[off+1]) << 8);
170 }
171
172 static int16_t
173 int16(uint8_t *bytes, int off)
174 {
175         return (int16_t) uint16(bytes, off);
176 }
177
178 static uint32_t
179 uint32(uint8_t *bytes, int off)
180 {
181         return (uint32_t) bytes[off] | (((uint32_t) bytes[off+1]) << 8) |
182                 (((uint32_t) bytes[off+2]) << 16) |
183                 (((uint32_t) bytes[off+3]) << 24);
184 }
185
186 static int32_t
187 int32(uint8_t *bytes, int off)
188 {
189         return (int32_t) uint32(bytes, off);
190 }
191 #endif
192
193 static uint32_t
194 uint24(uint8_t *bytes, int off)
195 {
196         return (uint32_t) bytes[off] | (((uint32_t) bytes[off+1]) << 8) |
197                 (((uint32_t) bytes[off+2]) << 16);
198 }
199
200 static int32_t
201 int24(uint8_t *bytes, int off)
202 {
203         return (int32_t) uint24(bytes, off);
204 }
205
206 int
207 main (int argc, char **argv)
208 {
209         struct ao_eeprom        *eeprom;
210         FILE                    *file;
211         int                     c;
212         bool                    raw = false;
213         bool                    csum = false;
214         bool                    verbose = false;
215         int                     arg_len = 0;
216         char                    *end;
217         int                     ret = 0;
218         int                     i;
219
220         while ((c = getopt_long(argc, argv, "rcvl:", options, NULL)) != -1) {
221                 switch (c) {
222                 case 'r':
223                         raw = true;
224                         break;
225                 case 'c':
226                         csum = true;
227                         break;
228                 case 'v':
229                         verbose = true;
230                         break;
231                 case 'l':
232                         arg_len = strtol(optarg, &end, 0);
233                         if (!*optarg || *end)
234                                 usage(argv[0]);
235                         break;
236                 default:
237                         usage(argv[0]);
238                         break;
239                 }
240         }
241         for (i = optind; i < argc; i++) {
242                 file = fopen(argv[i], "r");
243                 if (!file) {
244                         perror(argv[i]);
245                         ret++;
246                         continue;
247                 }
248                 eeprom = ao_eeprom_read(file);
249                 fclose(file);
250                 if (!eeprom) {
251                         perror(argv[i]);
252                         ret++;
253                         continue;
254                 }
255                 int     len = 0;
256                 bool    is_ms5611 = false;
257
258                 int64_t current_tick = 0;
259                 int64_t first_tick = 0x7fffffffffffffffLL;
260
261                 double  sense_r1 = 0.0, sense_r2 = 0.0;
262                 double  batt_r1 = 0.0, batt_r2 = 0.0;
263                 double  adc_ref = 0.0;
264                 double  pressure_sensor = 0.0;
265                 int16_t max_adc = 0;
266
267                 switch (eeprom->log_format) {
268                 case AO_LOG_FORMAT_TELEMEGA_OLD:
269                         len = 32;
270                         break;
271                 case AO_LOG_FORMAT_EASYMINI1:
272                         len = 16;
273                         max_adc = 32767;
274                         if (eeprom->serial_number < 1000)
275                                 adc_ref = 3.0;
276                         else
277                                 adc_ref = 3.3;
278                         batt_r1 = sense_r1 = 100e3;
279                         batt_r2 = sense_r2 = 27e3;
280                         break;
281                 case AO_LOG_FORMAT_TELEMETRUM:
282                         len = 16;
283                         max_adc = 4095;
284                         adc_ref = 3.3;
285                         batt_r1 = 5600;
286                         batt_r2 = 10000;
287                         sense_r1 = 100e3;
288                         sense_r2 = 27e3;
289                         break;
290                 case AO_LOG_FORMAT_TELEMINI2:
291                         len = 16;
292                         break;
293                 case AO_LOG_FORMAT_TELEGPS:
294                         len = 32;
295                         break;
296                 case AO_LOG_FORMAT_TELEMEGA:
297                         len = 32;
298                         max_adc = 4095;
299                         adc_ref = 3.3;
300                         batt_r1 = 5600;
301                         batt_r2 = 10000;
302                         sense_r1 = 100e3;
303                         sense_r2 = 27e3;
304                         break;
305                 case AO_LOG_FORMAT_DETHERM:
306                         len = 16;
307                         break;
308                 case AO_LOG_FORMAT_TELEMINI3:
309                         len = 16;
310                         max_adc = 4095;
311                         adc_ref = 3.3;
312                         batt_r1 = 5600;
313                         batt_r2 = 10000;
314                         sense_r1 = 100e3;
315                         sense_r2 = 27e3;
316                         break;
317                 case AO_LOG_FORMAT_TELEFIRETWO:
318                         len = 32;
319                         pressure_sensor = 2500.0;
320                         max_adc = 4095;
321                         adc_ref = 3.3;
322                         sense_r1 = batt_r1 = 5600;
323                         sense_r2 = batt_r2 = 10000;
324                         break;
325                 case AO_LOG_FORMAT_EASYMINI2:
326                         len = 16;
327                         max_adc = 4095;
328                         adc_ref = 3.3;
329                         batt_r1 = sense_r1 = 100e3;
330                         batt_r2 = sense_r2 = 27e3;
331                         break;
332                 case AO_LOG_FORMAT_TELEMEGA_3:
333                         len = 32;
334                         max_adc = 4095;
335                         adc_ref = 3.3;
336                         batt_r1 = 5600;
337                         batt_r2 = 10000;
338                         sense_r1 = 100e3;
339                         sense_r2 = 27e3;
340                         break;
341                 case AO_LOG_FORMAT_EASYMEGA_2:
342                         len = 32;
343                         max_adc = 4095;
344                         adc_ref = 3.3;
345                         batt_r1 = 5600;
346                         batt_r2 = 10000;
347                         sense_r1 = 100e3;
348                         sense_r2 = 27e3;
349                         break;
350                 case AO_LOG_FORMAT_TELESTATIC:
351                         len = 32;
352                         break;
353                 case AO_LOG_FORMAT_MICROPEAK2:
354                         len = 2;
355                         break;
356                 case AO_LOG_FORMAT_TELEMEGA_4:
357                         len = 32;
358                         break;
359                         max_adc= 4095;
360                         adc_ref = 3.3;
361                         batt_r1 = 5600;
362                         batt_r2 = 10000;
363                         sense_r1 = 100e3;
364                         sense_r2 = 27e3;
365                         break;
366                 case AO_LOG_FORMAT_EASYMOTOR:
367                         len = 16;
368                         max_adc = 32767;
369                         adc_ref = 3.3;
370                         pressure_sensor = 1600.0;
371                         batt_r1 = 5600;
372                         batt_r2 = 10000;
373                         sense_r1 = 5600;
374                         sense_r2 = 10000;
375                         break;
376                 }
377                 if (arg_len)
378                         len = arg_len;
379                 if (verbose)
380                         printf("config major %d minor %d log format %d total %u len %d\n",
381                                eeprom->config.major,
382                                eeprom->config.minor,
383                                eeprom->log_format,
384                                eeprom->len,
385                                len);
386
387                 uint32_t        pos;
388                 for (pos = 0; pos < eeprom->len; pos += len) {
389                         int i;
390                         if (raw) {
391                                 printf("%9u", pos);
392                                 for (i = 0; i < len; i++)
393                                         printf(" %02x", eeprom->data[pos + i]);
394                         } else {
395                                 struct ao_log_mega *log_mega;
396                                 struct ao_log_mini *log_mini;
397                                 struct ao_log_metrum *log_metrum;
398                                 struct ao_log_gps *log_gps;
399                                 struct ao_log_firetwo *log_firetwo;
400                                 struct ao_log_motor *log_motor;
401
402                                 if (!csum && !ao_csum_valid(&eeprom->data[pos], len)) {
403                                         if (verbose)
404                                                 printf("\tchecksum error at %d\n", pos);
405                                         continue;
406                                 }
407
408                                 struct ao_log_header *log_header = (struct ao_log_header *) &eeprom->data[pos];
409
410                                 if (first_tick == 0x7fffffffffffffffLL) {
411                                         current_tick = first_tick = log_header->tick;
412                                 } else {
413                                         int16_t diff = (int16_t) (log_header->tick - (uint16_t) current_tick);
414
415                                         current_tick += diff;
416                                 }
417                                 printf("type %c tick %5u %6.2f S", log_header->type, log_header->tick, (current_tick - first_tick) / 100.0);
418
419                                 switch (eeprom->log_format) {
420                                 case AO_LOG_FORMAT_TELEMEGA_OLD:
421                                 case AO_LOG_FORMAT_TELEMEGA:
422                                 case AO_LOG_FORMAT_TELEMEGA_3:
423                                 case AO_LOG_FORMAT_EASYMEGA_2:
424                                 case AO_LOG_FORMAT_TELEMEGA_4:
425                                         log_mega = (struct ao_log_mega *) &eeprom->data[pos];
426                                         switch (log_mega->type) {
427                                         case AO_LOG_FLIGHT:
428                                                 printf(" serial %5u flight %5u ground_accel %6d ground_pres %9u kPa  %7.1f  %7.1f m",
429                                                        eeprom->serial_number,
430                                                        log_mega->u.flight.flight,
431                                                        log_mega->u.flight.ground_accel,
432                                                        log_mega->u.flight.ground_pres,
433                                                        log_mega->u.flight.ground_pres / 1000.0,
434                                                        ao_pressure_to_altitude(log_mega->u.flight.ground_pres));
435
436                                                 printf(" along %6d aross %6d through %6d",
437                                                        log_mega->u.flight.ground_accel_along,
438                                                        log_mega->u.flight.ground_accel_across,
439                                                        log_mega->u.flight.ground_accel_through);
440                                                 printf(" roll %6d pitch %6d yaw %6d",
441                                                        log_mega->u.flight.ground_roll,
442                                                        log_mega->u.flight.ground_pitch,
443                                                        log_mega->u.flight.ground_yaw);
444                                                 break;
445                                         case AO_LOG_STATE:
446                                                 ao_state(log_mega->u.state.state,
447                                                          log_mega->u.state.reason);
448                                                 break;
449                                         case AO_LOG_SENSOR:
450                                                 ao_ms5607(log_mega->u.sensor.pres,
451                                                           log_mega->u.sensor.temp,
452                                                           eeprom, is_ms5611);
453                                                 printf(" accel_x %6d accel_y %6d accel_z %6d",
454                                                        log_mega->u.sensor.accel_x,
455                                                        log_mega->u.sensor.accel_y,
456                                                        log_mega->u.sensor.accel_z);
457                                                 printf (" gyro_x %6d gyro_y %6d gyro_z %6d",
458                                                        log_mega->u.sensor.gyro_x,
459                                                        log_mega->u.sensor.gyro_y,
460                                                        log_mega->u.sensor.gyro_z);
461                                                 printf (" mag_x %6d mag_y %6d mag_z %6d",
462                                                        log_mega->u.sensor.mag_x,
463                                                        log_mega->u.sensor.mag_y,
464                                                        log_mega->u.sensor.mag_z);
465                                                 ao_accel(log_mega->u.sensor.accel, eeprom);
466                                                 break;
467                                         case AO_LOG_TEMP_VOLT:
468                                                 ao_volts("v_batt",
469                                                          log_mega->u.volt.v_batt,
470                                                          max_adc,
471                                                          adc_ref,
472                                                          batt_r1, batt_r2);
473                                                 ao_volts("v_pbatt",
474                                                          log_mega->u.volt.v_pbatt,
475                                                          max_adc,
476                                                          adc_ref,
477                                                          sense_r1, sense_r2);
478                                                 printf(" n_sense %1d",
479                                                        log_mega->u.volt.n_sense);
480                                                 for (i = 0; i < log_mega->u.volt.n_sense; i++) {
481                                                         char name[10];
482                                                         sprintf(name, "sense%d", i);
483                                                         ao_volts(name,
484                                                                  log_mega->u.volt.sense[i],
485                                                                  max_adc,
486                                                                  adc_ref,
487                                                                  sense_r1, sense_r2);
488                                                 }
489                                                 printf(" pyro %04x", log_mega->u.volt.pyro);
490                                                 break;
491                                         case AO_LOG_GPS_TIME:
492                                                 printf(" lat %10.7f ° lon %10.7f ° alt %8d m",
493                                                        log_mega->u.gps.latitude / 10000000.0,
494                                                        log_mega->u.gps.longitude/ 10000000.0,
495                                                        (int32_t) (log_mega->u.gps.altitude_low |
496                                                                   (log_mega->u.gps.altitude_high << 16)));
497                                                 printf(" time %02d:%02d:%02d %04d-%02d-%02d flags %02x",
498                                                        log_mega->u.gps.hour,
499                                                        log_mega->u.gps.minute,
500                                                        log_mega->u.gps.second,
501                                                        log_mega->u.gps.year + 2000,
502                                                        log_mega->u.gps.month,
503                                                        log_mega->u.gps.day,
504                                                        log_mega->u.gps.flags);
505                                                 printf(" course %3d ground_speed %5u climb_rate %6d pdop %3d hdop %3d vdop %3d mode %3d",
506                                                        log_mega->u.gps.course,
507                                                        log_mega->u.gps.ground_speed,
508                                                        log_mega->u.gps.climb_rate,
509                                                        log_mega->u.gps.pdop,
510                                                        log_mega->u.gps.hdop,
511                                                        log_mega->u.gps.vdop,
512                                                        log_mega->u.gps.mode);
513                                                 break;
514                                         case AO_LOG_GPS_SAT:
515                                                 printf(" channels %2d",
516                                                        log_mega->u.gps_sat.channels);
517                                                 for (i = 0; i < 12; i++) {
518                                                         printf(" svid %3d c_n %2d",
519                                                                log_mega->u.gps_sat.sats[i].svid,
520                                                                log_mega->u.gps_sat.sats[i].c_n);
521                                                 }
522                                                 break;
523                                         }
524                                         break;
525                                 case AO_LOG_FORMAT_EASYMINI1:
526                                 case AO_LOG_FORMAT_EASYMINI2:
527                                 case AO_LOG_FORMAT_TELEMINI2:
528                                 case AO_LOG_FORMAT_TELEMINI3:
529                                         log_mini = (struct ao_log_mini *) &eeprom->data[pos];
530                                         switch (log_mini->type) {
531                                         case AO_LOG_FLIGHT:
532                                                 printf(" serial %5u flight %5u ground_pres %9u kPa  %7.1f  %7.1f m",
533                                                        eeprom->serial_number,
534                                                        log_mini->u.flight.flight,
535                                                        log_mini->u.flight.ground_pres,
536                                                        log_mini->u.flight.ground_pres / 1000.0,
537                                                        ao_pressure_to_altitude(log_mini->u.flight.ground_pres));
538                                                 break;
539                                         case AO_LOG_STATE:
540                                                 ao_state(log_mini->u.state.state,
541                                                          log_mini->u.state.reason);
542                                                 break;
543                                         case AO_LOG_SENSOR:
544                                                 ao_ms5607(int24(log_mini->u.sensor.pres, 0),
545                                                           int24(log_mini->u.sensor.temp, 0),
546                                                           eeprom, is_ms5611);
547                                                 ao_volts("sense_a",
548                                                          log_mini->u.sensor.sense_a, max_adc,
549                                                          adc_ref, sense_r1, sense_r2);
550                                                 ao_volts("sense_m",
551                                                          log_mini->u.sensor.sense_m, max_adc,
552                                                          adc_ref, sense_r1, sense_r2);
553                                                 ao_volts("v_batt",
554                                                          log_mini->u.sensor.v_batt, max_adc,
555                                                          adc_ref, batt_r1, batt_r2);
556                                                 break;
557                                         } /*  */
558                                         break;
559                                 case AO_LOG_FORMAT_TELEMETRUM:
560                                         log_metrum = (struct ao_log_metrum *) &eeprom->data[pos];
561                                         switch (log_metrum->type) {
562                                         case AO_LOG_FLIGHT:
563                                                 printf(" serial %5u flight %5u ground_accel %6d ground_pres %9u kPa  %7.1f  %7.1f m ground_temp %9u",
564                                                        eeprom->serial_number,
565                                                        log_metrum->u.flight.flight,
566                                                        log_metrum->u.flight.ground_accel,
567                                                        log_metrum->u.flight.ground_pres,
568                                                        log_metrum->u.flight.ground_pres / 1000.0,
569                                                        ao_pressure_to_altitude(log_metrum->u.flight.ground_pres),
570                                                        log_metrum->u.flight.ground_temp);
571                                                 break;
572                                         case AO_LOG_SENSOR:
573                                                 ao_ms5607(log_metrum->u.sensor.pres,
574                                                           log_metrum->u.sensor.temp,
575                                                           eeprom, is_ms5611);
576                                                 ao_accel(log_metrum->u.sensor.accel, eeprom);
577                                                 break;
578                                         case AO_LOG_TEMP_VOLT:
579                                                 ao_volts("v_batt",
580                                                          log_metrum->u.volt.v_batt, max_adc,
581                                                          adc_ref, batt_r1, batt_r2);
582                                                 ao_volts("sense_a",
583                                                          log_metrum->u.volt.sense_a, max_adc,
584                                                          adc_ref, sense_r1, sense_r2);
585                                                 ao_volts("sense_m",
586                                                          log_metrum->u.volt.sense_m, max_adc,
587                                                          adc_ref, sense_r1, sense_r2);
588                                                 break;
589                                         case AO_LOG_DEPLOY:
590                                                 break;
591                                         case AO_LOG_STATE:
592                                                 ao_state(log_metrum->u.state.state,
593                                                          log_metrum->u.state.reason);
594                                                 break;
595                                         case AO_LOG_GPS_TIME:
596                                                 printf(" time %02d:%02d:%02d 20%02d-%02d-%02d flags %02x pdop %3u",
597                                                        log_metrum->u.gps_time.hour,
598                                                        log_metrum->u.gps_time.minute,
599                                                        log_metrum->u.gps_time.second,
600                                                        log_metrum->u.gps_time.year,
601                                                        log_metrum->u.gps_time.month,
602                                                        log_metrum->u.gps_time.day,
603                                                        log_metrum->u.gps_time.flags,
604                                                        log_metrum->u.gps_time.pdop);
605                                                 break;
606                                         case AO_LOG_GPS_SAT:
607                                                 printf(" channels %2d more %1d",
608                                                        log_metrum->u.gps_sat.channels,
609                                                        log_metrum->u.gps_sat.more);
610                                                 for (i = 0; i < 4; i++) {
611                                                         printf(" svid %3d c_n %2d",
612                                                                log_metrum->u.gps_sat.sats[i].svid,
613                                                                log_metrum->u.gps_sat.sats[i].c_n);
614                                                 }
615                                                 break;
616                                         case AO_LOG_GPS_POS:
617                                                 printf(" lat %10.7f° lon %10.7f° alt %8d m",
618                                                        log_metrum->u.gps.latitude / 10000000.0,
619                                                        log_metrum->u.gps.longitude/ 10000000.0,
620                                                        (int32_t) (log_metrum->u.gps.altitude_low |
621                                                                   (log_metrum->u.gps.altitude_high << 16)));
622                                                 break;
623                                         default:
624                                                 printf(" unknown");
625                                         }
626                                         break;
627                                 case AO_LOG_FORMAT_TELEFIRETWO:
628                                         log_firetwo = (struct ao_log_firetwo *) &eeprom->data[pos];
629                                         switch (log_firetwo->type) {
630                                         case AO_LOG_FLIGHT:
631                                                 printf(" serial %5u flight %5u",
632                                                        eeprom->serial_number,
633                                                        log_firetwo->u.flight.flight);
634                                                 break;
635                                         case AO_LOG_STATE:
636                                                 ao_state(log_firetwo->u.state.state,
637                                                          log_firetwo->u.state.reason);
638                                                 break;
639                                         case AO_LOG_SENSOR:
640                                                 ao_pressure(log_firetwo->u.sensor.pressure,
641                                                             max_adc, adc_ref,
642                                                             sense_r1, sense_r2,
643                                                             pressure_sensor);
644                                                 ao_thrust(log_firetwo->u.sensor.thrust,
645                                                           max_adc, adc_ref,
646                                                           sense_r1, sense_r2);
647                                                 for (i = 0; i < 4; i++) {
648                                                         char name[20];
649                                                         sprintf(name, "thermistor%d", i);
650                                                         ao_volts(name,
651                                                                  log_firetwo->u.sensor.thermistor[i],
652                                                                  max_adc, adc_ref,
653                                                                  sense_r1, sense_r2);
654                                                 }
655                                                 break;
656                                         }
657                                         break;
658                                 case AO_LOG_FORMAT_TELEGPS:
659                                         log_gps = (struct ao_log_gps *) &eeprom->data[pos];
660                                         switch (log_gps->type) {
661                                         case AO_LOG_GPS_TIME:
662                                                 printf(" lat %10.7f ° lon %10.7f ° alt %8d m",
663                                                        log_gps->u.gps.latitude / 10000000.0,
664                                                        log_gps->u.gps.longitude/ 10000000.0,
665                                                        (int32_t) (log_gps->u.gps.altitude_low |
666                                                                   (log_gps->u.gps.altitude_high << 16)));
667                                                 printf(" time %02d:%02d:%02d %04d-%02d-%02d flags %02x",
668                                                        log_gps->u.gps.hour,
669                                                        log_gps->u.gps.minute,
670                                                        log_gps->u.gps.second,
671                                                        log_gps->u.gps.year + 2000,
672                                                        log_gps->u.gps.month,
673                                                        log_gps->u.gps.day,
674                                                        log_gps->u.gps.flags);
675                                                 printf(" course %3d ground_speed %5u climb_rate %6d pdop %3d hdop %3d vdop %3d mode %3d",
676                                                        log_gps->u.gps.course,
677                                                        log_gps->u.gps.ground_speed,
678                                                        log_gps->u.gps.climb_rate,
679                                                        log_gps->u.gps.pdop,
680                                                        log_gps->u.gps.hdop,
681                                                        log_gps->u.gps.vdop,
682                                                        log_gps->u.gps.mode);
683                                                 break;
684                                         case AO_LOG_GPS_SAT:
685                                                 printf(" channels %2d",
686                                                        log_gps->u.gps_sat.channels);
687                                                 for (i = 0; i < 12; i++) {
688                                                         printf(" svid %3d c_n %2d",
689                                                                log_gps->u.gps_sat.sats[i].svid,
690                                                                log_gps->u.gps_sat.sats[i].c_n);
691                                                 }
692                                                 break;
693                                         default:
694                                                 printf (" unknown");
695                                                 break;
696                                         }
697                                         break;
698                                 case AO_LOG_FORMAT_DETHERM:
699                                         break;
700                                 case AO_LOG_FORMAT_EASYMOTOR:
701                                         log_motor = (struct ao_log_motor *) &eeprom->data[pos];
702                                         switch (log_motor->type) {
703                                         case AO_LOG_FLIGHT:
704                                                 printf(" serial %5u flight %5u",
705                                                        eeprom->serial_number,
706                                                        log_motor->u.flight.flight);
707                                                 break;
708                                         case AO_LOG_STATE:
709                                                 ao_state(log_motor->u.state.state,
710                                                          log_motor->u.state.reason);
711                                                 break;
712                                         case AO_LOG_SENSOR:
713                                                 ao_pressure(log_motor->u.sensor.pressure,
714                                                             max_adc, adc_ref,
715                                                             sense_r1, sense_r2,
716                                                             pressure_sensor);
717                                                 ao_volts("v_batt",
718                                                          log_motor->u.sensor.v_batt,
719                                                          max_adc,
720                                                          adc_ref,
721                                                          batt_r1, batt_r2);
722                                                 break;
723                                         }
724                                         break;
725                                 }
726                         }
727                         printf("\n");
728                 }
729         }
730         return ret;
731 }