altoslib: Compute speed at entry to each state
[fw/altos] / altoslib / AltosEepromRecordSet.java
1 /*
2  * Copyright © 2017 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
15 package org.altusmetrum.altoslib_12;
16
17 import java.io.*;
18 import java.util.*;
19
20 public class AltosEepromRecordSet implements AltosRecordSet {
21         AltosEeprom                     eeprom;
22         TreeSet<AltosEepromRecord>      ordered;
23         AltosCalData                    cal_data;
24
25         public AltosConfigData config_data() {
26                 return eeprom.config_data();
27         }
28
29         public AltosCalData cal_data() {
30                 if (cal_data == null) {
31                         cal_data = new AltosCalData(config_data());
32                         for (AltosEepromRecord record : ordered) {
33                                 if (record.cmd() == AltosLib.AO_LOG_FLIGHT) {
34                                         cal_data.set_tick(record.tick());
35                                         cal_data.set_boost_tick();
36                                         break;
37                                 }
38                         }
39                 }
40                 return cal_data;
41         }
42
43         public void capture_series(AltosDataListener listener) {
44                 AltosCalData    cal_data = cal_data();
45
46                 cal_data.reset();
47                 for (AltosEepromRecord record : ordered) {
48                         record.provide_data(listener, cal_data);
49                 }
50                 listener.finish();
51         }
52
53         public AltosEepromRecordSet(AltosEeprom eeprom) {
54                 this.eeprom = eeprom;
55
56                 AltosConfigData         config_data = eeprom.config_data();
57
58                 AltosEepromRecord       record = null;
59
60                 switch (config_data.log_format) {
61                 case AltosLib.AO_LOG_FORMAT_FULL:
62                         record = new AltosEepromRecordFull(eeprom);
63                         break;
64                 case AltosLib.AO_LOG_FORMAT_TINY:
65                         record = new AltosEepromRecordTiny(eeprom);
66                         break;
67                 case AltosLib.AO_LOG_FORMAT_TELEMETRY:
68                 case AltosLib.AO_LOG_FORMAT_TELESCIENCE:
69                 case AltosLib.AO_LOG_FORMAT_TELEMEGA:
70                 case AltosLib.AO_LOG_FORMAT_TELEMEGA_OLD:
71                         record = new AltosEepromRecordMega(eeprom);
72                         break;
73                 case AltosLib.AO_LOG_FORMAT_TELEMETRUM:
74                         record = new AltosEepromRecordMetrum(eeprom);
75                         break;
76                 case AltosLib.AO_LOG_FORMAT_TELEMINI2:
77                 case AltosLib.AO_LOG_FORMAT_TELEMINI3:
78                 case AltosLib.AO_LOG_FORMAT_EASYMINI1:
79                 case AltosLib.AO_LOG_FORMAT_EASYMINI2:
80                         record = new AltosEepromRecordMini(eeprom);
81                         break;
82                 case AltosLib.AO_LOG_FORMAT_TELEGPS:
83                         record = new AltosEepromRecordGps(eeprom);
84                         break;
85                 case AltosLib.AO_LOG_FORMAT_TELEFIRETWO:
86                         record = new AltosEepromRecordFireTwo(eeprom);
87                         break;
88                 }
89
90                 if (record == null) {
91                         System.out.printf("failed to parse log format %d\n", config_data.log_format);
92                         return;
93                 }
94                 ordered = new TreeSet<AltosEepromRecord>();
95                 int     tick = 0;
96                 boolean first = true;
97
98                 for (;;) {
99                         int     t = record.tick();
100
101                         if (first) {
102                                 tick = t;
103                                 first = false;
104                         } else {
105                                 while (t < tick - 32767)
106                                         t += 65536;
107                                 tick = t;
108                         }
109                         record.wide_tick = tick;
110                         ordered.add(record);
111                         if (!record.hasNext())
112                                 break;
113                         record = record.next();
114                 }
115         }
116
117         public AltosEepromRecordSet(InputStream input) throws IOException {
118                 this(new AltosEeprom(input));
119         }
120 }