2 * Copyright © 2012 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; either version 2 of the License, or
7 * (at your option) any later version.
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.
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.
22 #include <ao_flight.h>
28 /* We record flight numbers in the first record of
29 * the log. Tasks may wait for this to be initialized
30 * by sleeping on this variable.
32 extern uint16_t ao_flight_number;
33 extern uint8_t ao_log_mutex;
34 extern uint32_t ao_log_current_pos;
35 extern uint32_t ao_log_end_pos;
36 extern uint32_t ao_log_start_pos;
37 extern uint8_t ao_log_running;
38 extern enum ao_flight_state ao_log_state;
40 /* required functions from the underlying log system */
42 #define AO_LOG_FORMAT_UNKNOWN 0 /* unknown; altosui will have to guess */
43 #define AO_LOG_FORMAT_FULL 1 /* 8 byte typed log records */
44 #define AO_LOG_FORMAT_TINY 2 /* two byte state/baro records */
45 #define AO_LOG_FORMAT_TELEMETRY 3 /* 32 byte ao_telemetry records */
46 #define AO_LOG_FORMAT_TELESCIENCE 4 /* 32 byte typed telescience records */
47 #define AO_LOG_FORMAT_TELEMEGA_OLD 5 /* 32 byte typed telemega records */
48 #define AO_LOG_FORMAT_EASYMINI1 6 /* 16-byte MS5607 baro only, 3.0V supply */
49 #define AO_LOG_FORMAT_TELEMETRUM 7 /* 16-byte typed telemetrum records */
50 #define AO_LOG_FORMAT_TELEMINI2 8 /* 16-byte MS5607 baro only, 3.3V supply, cc1111 SoC */
51 #define AO_LOG_FORMAT_TELEGPS 9 /* 32 byte telegps records */
52 #define AO_LOG_FORMAT_TELEMEGA 10 /* 32 byte typed telemega records with 32 bit gyro cal */
53 #define AO_LOG_FORMAT_DETHERM 11 /* 16-byte MS5607 baro only, no ADC */
54 #define AO_LOG_FORMAT_TELEMINI3 12 /* 16-byte MS5607 baro only, 3.3V supply, stm32f042 SoC */
55 #define AO_LOG_FORMAT_TELEFIRETWO 13 /* 32-byte test stand data */
56 #define AO_LOG_FORMAT_EASYMINI2 14 /* 16-byte MS5607 baro only, 3.3V supply, stm32f042 SoC */
57 #define AO_LOG_FORMAT_TELEMEGA_3 15 /* 32 byte typed telemega records with 32 bit gyro cal and mpu9250 */
58 #define AO_LOG_FORMAT_EASYMEGA_2 16 /* 32 byte typed telemega records with 32 bit gyro cal, mpu9250 rotated 90° and adxl375 */
59 #define AO_LOG_FORMAT_TELESTATIC 17 /* 32 byte typed telestatic records */
60 #define AO_LOG_FORMAT_MICROPEAK2 18 /* 2-byte baro values with header */
61 #define AO_LOG_FORMAT_TELEMEGA_4 19 /* 32 byte typed telemega records with 32 bit gyro cal and Bmx160 */
62 #define AO_LOG_FORMAT_EASYMOTOR 20 /* 16 byte typed easymotor records with pressure sensor and adxl375 */
63 #define AO_LOG_FORMAT_TELEMEGA_5 21 /* 32 byte typed telemega records with 32 bit gyro cal, mpu6000 and mmc5983 */
64 #define AO_LOG_FORMAT_TELEMEGA_6 22 /* 32 byte typed telemega records with 32 bit gyro cal, bmi088 and mmc5983 */
65 #define AO_LOG_FORMAT_EASYTIMER_2 23 /* 32 byte typed easytimer records with 32 bit gyro cal, bmi088 and mmc5983 */
66 #define AO_LOG_FORMAT_NONE 127 /* No log at all */
68 /* Return the flight number from the given log slot, 0 if none, -slot on failure */
71 ao_log_flight(uint8_t slot);
73 /* Checksum the loaded log record */
75 ao_log_check_data(void);
77 /* Check to see if the loaded log record is empty */
79 ao_log_check_clear(void);
81 /* Check if there is valid log data at the specified location */
82 #define AO_LOG_VALID 1
83 #define AO_LOG_EMPTY 0
84 #define AO_LOG_INVALID -1
87 ao_log_check(uint32_t pos);
93 /* Logging thread main routine */
97 /* functions provided in ao_log.c */
99 /* Figure out the current flight number */
103 /* Start logging to eeprom */
111 /* Initialize the logging system */
115 /* Write out the current flight number to the erase log */
117 ao_log_write_erase(uint8_t pos);
119 /* Returns true if there are any logs stored in eeprom */
121 ao_log_present(void);
123 /* Returns true if there is no more storage space available */
132 * The data log is recorded in the eeprom as a sequence
135 * Each packet starts with a 4-byte header that has the
136 * packet type, the packet checksum and the tick count. Then
137 * they all contain 2 16 bit values which hold packet-specific
140 * For each flight, the first packet
141 * is FLIGHT packet, indicating the serial number of the
142 * device and a unique number marking the number of flights
143 * recorded by this device.
145 * During flight, data from the accelerometer and barometer
146 * are recorded in SENSOR packets, using the raw 16-bit values
147 * read from the A/D converter.
149 * Also during flight, but at a lower rate, the deployment
150 * sensors are recorded in DEPLOY packets. The goal here is to
151 * detect failure in the deployment circuits.
153 * STATE packets hold state transitions as the flight computer
154 * transitions through different stages of the flight.
156 #define AO_LOG_FLIGHT 'F'
157 #define AO_LOG_SENSOR 'A'
158 #define AO_LOG_TEMP_VOLT 'T'
159 #define AO_LOG_DEPLOY 'D'
160 #define AO_LOG_STATE 'S'
161 #define AO_LOG_GPS_TIME 'G'
162 #define AO_LOG_GPS_LAT 'N'
163 #define AO_LOG_GPS_LON 'W'
164 #define AO_LOG_GPS_ALT 'H'
165 #define AO_LOG_GPS_SAT 'V'
166 #define AO_LOG_GPS_DATE 'Y'
167 #define AO_LOG_GPS_POS 'P'
169 #define AO_LOG_POS_NONE (~0UL)
171 struct ao_log_record {
173 uint8_t csum; /* 1 */
174 uint16_t tick; /* 2 */
177 int16_t ground_accel; /* 4 */
178 uint16_t flight; /* 6 */
181 int16_t accel; /* 4 */
182 int16_t pres; /* 6 */
202 int32_t gps_latitude;
203 int32_t gps_longitude;
205 uint16_t altitude_low;
206 int16_t altitude_high;
228 uint8_t csum; /* 1 */
229 uint16_t tick; /* 2 */
233 uint16_t flight; /* 4 */
234 int16_t ground_accel; /* 6 */
235 int32_t ground_pres; /* 8 */
236 int16_t ground_accel_along; /* 12 */
237 int16_t ground_accel_across; /* 14 */
238 int16_t ground_accel_through; /* 16 */
239 int16_t pad_18; /* 18 */
240 int32_t ground_roll; /* 20 */
241 int32_t ground_pitch; /* 24 */
242 int32_t ground_yaw; /* 28 */
245 uint16_t flight; /* 4 */
246 int16_t ground_accel; /* 6 */
247 int32_t ground_pres; /* 8 */
248 int16_t ground_accel_along; /* 12 */
249 int16_t ground_accel_across; /* 14 */
250 int16_t ground_accel_through; /* 16 */
251 int16_t ground_roll; /* 18 */
252 int16_t ground_pitch; /* 20 */
253 int16_t ground_yaw; /* 22 */
254 } flight_old; /* 24 */
262 uint32_t pres; /* 4 */
263 uint32_t temp; /* 8 */
266 int16_t accel_along; /* 12 */
267 int16_t accel_across; /* 14 */
268 int16_t accel_through; /* 16 */
269 int16_t gyro_roll; /* 18 */
270 int16_t gyro_pitch; /* 20 */
271 int16_t gyro_yaw; /* 22 */
272 int16_t mag_along; /* 24 */
273 int16_t mag_across; /* 26 */
274 int16_t mag_through; /* 28 */
277 int16_t accel_x; /* 12 */
278 int16_t accel_y; /* 14 */
279 int16_t accel_z; /* 16 */
280 int16_t gyro_x; /* 18 */
281 int16_t gyro_y; /* 20 */
282 int16_t gyro_z; /* 22 */
283 int16_t mag_x; /* 24 */
284 int16_t mag_z; /* 26 */
285 int16_t mag_y; /* 28 */
288 int16_t accel; /* 30 */
290 /* AO_LOG_TEMP_VOLT */
292 int16_t v_batt; /* 4 */
293 int16_t v_pbatt; /* 6 */
294 int16_t n_sense; /* 8 */
295 int16_t sense[10]; /* 10 */
296 uint16_t pyro; /* 30 */
298 /* AO_LOG_GPS_TIME */
300 int32_t latitude; /* 4 */
301 int32_t longitude; /* 8 */
302 uint16_t altitude_low; /* 12 */
303 uint8_t hour; /* 14 */
304 uint8_t minute; /* 15 */
305 uint8_t second; /* 16 */
306 uint8_t flags; /* 17 */
307 uint8_t year; /* 18 */
308 uint8_t month; /* 19 */
309 uint8_t day; /* 20 */
310 uint8_t course; /* 21 */
311 uint16_t ground_speed; /* 22 */
312 int16_t climb_rate; /* 24 */
313 uint8_t pdop; /* 26 */
314 uint8_t hdop; /* 27 */
315 uint8_t vdop; /* 28 */
316 uint8_t mode; /* 29 */
317 int16_t altitude_high; /* 30 */
321 uint16_t channels; /* 4 */
330 #define AO_LOG_MEGA_GPS_ALTITUDE(l) ((int32_t) ((l)->u.gps.altitude_high << 16) | ((l)->u.gps.altitude_low))
331 #define AO_LOG_MEGA_SET_GPS_ALTITUDE(l,a) (((l)->u.gps.mode |= AO_GPS_MODE_ALTITUDE_24), \
332 ((l)->u.gps.altitude_high = (a) >> 16), \
333 (l)->u.gps.altitude_low = (a))
335 struct ao_log_firetwo {
337 uint8_t csum; /* 1 */
338 uint16_t tick; /* 2 */
342 uint16_t flight; /* 4 */
346 uint16_t state; /* 4 */
347 uint16_t reason; /* 6 */
351 uint16_t pressure; /* 4 */
352 uint16_t thrust; /* 6 */
353 uint16_t thermistor[4]; /* 8 */
355 uint8_t align[28]; /* 4 */
359 struct ao_log_telestatic {
361 uint8_t csum; /* 1 */
362 uint16_t tick; /* 2 */
366 uint16_t flight; /* 4 */
370 uint16_t state; /* 4 */
371 uint16_t reason; /* 6 */
375 uint32_t pressure; /* 4 */
376 uint32_t pressure2; /* 8 */
377 uint32_t thrust; /* 12 */
378 uint32_t mass; /* 16 */
379 uint16_t t_low; /* 20 */
380 uint16_t t_high[4]; /* 22 */
382 uint8_t align[28]; /* 4 */
386 struct ao_log_metrum {
388 uint8_t csum; /* 1 */
389 uint16_t tick; /* 2 */
393 uint16_t flight; /* 4 */
394 int16_t ground_accel; /* 6 */
395 int32_t ground_pres; /* 8 */
396 uint32_t ground_temp; /* 12 */
400 uint16_t state; /* 4 */
401 uint16_t reason; /* 6 */
405 uint32_t pres; /* 4 */
406 uint32_t temp; /* 8 */
407 int16_t accel; /* 12 */
409 /* AO_LOG_TEMP_VOLT */
411 int16_t v_batt; /* 4 */
412 int16_t sense_a; /* 6 */
413 int16_t sense_m; /* 8 */
417 int32_t latitude; /* 4 */
418 int32_t longitude; /* 8 */
419 uint16_t altitude_low; /* 12 */
420 int16_t altitude_high; /* 14 */
422 /* AO_LOG_GPS_TIME */
424 uint8_t hour; /* 4 */
425 uint8_t minute; /* 5 */
426 uint8_t second; /* 6 */
427 uint8_t flags; /* 7 */
428 uint8_t year; /* 8 */
429 uint8_t month; /* 9 */
430 uint8_t day; /* 10 */
431 uint8_t pdop; /* 11 */
433 /* AO_LOG_GPS_SAT (up to three packets) */
435 uint8_t channels; /* 4 */
436 uint8_t more; /* 5 */
442 uint8_t raw[12]; /* 4 */
448 uint8_t csum; /* 1 */
449 uint16_t tick; /* 2 */
453 uint16_t flight; /* 4 */
455 int32_t ground_pres; /* 8 */
459 uint16_t state; /* 4 */
460 uint16_t reason; /* 6 */
464 uint8_t pres[3]; /* 4 */
465 uint8_t temp[3]; /* 7 */
466 int16_t sense_a; /* 10 */
467 int16_t sense_m; /* 12 */
468 int16_t v_batt; /* 14 */
473 #define ao_log_pack24(dst,value) do { \
474 (dst)[0] = (uint8_t) (value); \
475 (dst)[1] = (uint8_t) ((value) >> 8); \
476 (dst)[2] = (uint8_t) ((value) >> 16); \
481 uint8_t csum; /* 1 */
482 uint16_t tick; /* 2 */
486 uint16_t flight; /* 4 */
487 int16_t start_altitude; /* 6 */
488 int32_t start_latitude; /* 8 */
489 int32_t start_longitude; /* 12 */
491 /* AO_LOG_GPS_TIME */
493 int32_t latitude; /* 4 */
494 int32_t longitude; /* 8 */
495 uint16_t altitude_low; /* 12 */
496 uint8_t hour; /* 14 */
497 uint8_t minute; /* 15 */
498 uint8_t second; /* 16 */
499 uint8_t flags; /* 17 */
500 uint8_t year; /* 18 */
501 uint8_t month; /* 19 */
502 uint8_t day; /* 20 */
503 uint8_t course; /* 21 */
504 uint16_t ground_speed; /* 22 */
505 int16_t climb_rate; /* 24 */
506 uint8_t pdop; /* 26 */
507 uint8_t hdop; /* 27 */
508 uint8_t vdop; /* 28 */
509 uint8_t mode; /* 29 */
510 int16_t altitude_high; /* 30 */
514 uint16_t channels; /* 4 */
523 struct ao_log_motor {
525 uint8_t csum; /* 1 */
526 uint16_t tick; /* 2 */
530 uint16_t flight; /* 4 */
531 int16_t ground_accel; /* 6 */
532 int16_t ground_accel_along; /* 8 */
533 int16_t ground_accel_across; /* 10 */
534 int16_t ground_accel_through; /* 12 */
535 int16_t ground_motor_pressure; /* 14 */
539 uint16_t state; /* 4 */
540 uint16_t reason; /* 6 */
544 uint16_t pressure; /* 4 */
545 uint16_t v_batt; /* 6 */
546 int16_t accel; /* 8 */
547 int16_t accel_across; /* 10 */
548 int16_t accel_along; /* 12 */
549 int16_t accel_through; /* 14 */
554 struct ao_log_timer {
556 uint8_t csum; /* 1 */
557 uint16_t tick; /* 2 */
561 uint16_t flight; /* 4 */
562 int16_t ground_accel; /* 6 */
563 int16_t ground_accel_along; /* 8 */
564 int16_t ground_accel_across; /* 10 */
565 int16_t ground_accel_through; /* 12 */
566 int16_t pad_14; /* 14 */
567 int32_t ground_roll; /* 16 */
568 int32_t ground_pitch; /* 20 */
569 int32_t ground_yaw; /* 24 */
573 uint16_t state; /* 4 */
574 uint16_t reason; /* 6 */
578 int16_t accel_along; /* 4 */
579 int16_t accel_across; /* 6 */
580 int16_t accel_through; /* 8 */
581 int16_t gyro_roll; /* 10 */
582 int16_t gyro_pitch; /* 12 */
583 int16_t gyro_yaw; /* 14 */
584 int16_t mag_along; /* 16 */
585 int16_t mag_across; /* 18 */
586 int16_t mag_through; /* 20 */
587 int16_t v_batt; /* 22 */
588 int16_t v_pbatt; /* 24 */
589 int16_t sense[2]; /* 26 */
590 uint16_t pyro; /* 30 */
595 #if AO_LOG_FORMAT == AO_LOG_FOMAT_TELEMEGA_OLD || AO_LOG_FORMAT == AO_LOG_FORMAT_TELEMEGA || AO_LOG_FORMAT == AO_LOG_FORMAT_TELEMEGA_3 || AO_LOG_FORMAT == AO_LOG_FORMAT_EASYMEGA_2 || AO_LOG_FORMAT == AO_LOG_FORMAT_TELEMEGA_4 || AO_LOG_FORMAT == AO_LOG_FORMAT_TELEMEGA_5 || AO_LOG_FORMAT == AO_LOG_FORMAT_TELEMEGA_6
596 typedef struct ao_log_mega ao_log_type;
599 #if AO_LOG_FORMAT == AO_LOG_FORMAT_TELEMETRUM
600 typedef struct ao_log_metrum ao_log_type;
603 #if AO_LOG_FORMAT == AO_LOG_FORMAT_TELEFIRETWO
604 typedef struct ao_log_firetwo ao_log_type;
607 #if AO_LOG_FORMAT == AO_LOG_FORMAT_EASYMINI1 || AO_LOG_FORMAT == AO_LOG_FORMAT_EASYMINI2 || AO_LOG_FORMAT == AO_LOG_FORMAT_TELEMINI2 || AO_LOG_FORMAT == AO_LOG_FORMAT_TELEMINI3
608 typedef struct ao_log_mini ao_log_type;
611 #if AO_LOG_FORMAT == AO_LOG_FORMAT_EASYMOTOR
612 typedef struct ao_log_motor ao_log_type;
615 #if AO_LOG_FORMAT == AO_LOG_FORMAT_TELEGPS
616 typedef struct ao_log_gps ao_log_type;
619 #if AO_LOG_FORMAT == AO_LOG_FORMAT_FULL
620 typedef struct ao_log_record ao_log_type;
623 #if AO_LOG_FORMAT == AO_LOG_FORMAT_TINY
624 #define AO_LOG_UNCOMMON 1
627 #if AO_LOG_FORMAT == AO_LOG_FORMAT_TELEMETRY
628 #define AO_LOG_UNCOMMON 1
631 #if AO_LOG_FORMAT == AO_LOG_FORMAT_TELESCIENCE
632 #define AO_LOG_UNCOMMON 1
635 #if AO_LOG_FORMAT == AO_LOG_FORMAT_MICROPEAK2
636 #define AO_LOG_UNCOMMON 1
639 #if AO_LOG_FORMAT == AO_LOG_FORMAT_EASYTIMER_2
640 typedef struct ao_log_timer ao_log_type;
643 #ifndef AO_LOG_UNCOMMON
644 extern ao_log_type ao_log_data;
646 #define AO_LOG_SIZE sizeof(ao_log_type)
648 /* Write a record to the eeprom log */
651 ao_log_write(ao_log_type *log);
658 ao_gps_report_metrum_init(void);
660 #endif /* _AO_LOG_H_ */