1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
|
#include "log_format.hpp"
void print_log_entry(const uint8_t* entry) {
static bool first_call = true;
if (first_call) {
printf("time_us,state,temperature_chip_celsius,deployment_percent,pressure_mb,altitude,altitude_filt,velocity_filt,temperature_alt_celsius,mid_imu_ax,mid_imu_ay,mid_imu_az,mid_imu_gx,mid_imu_gy,mid_imu_gz,mag_x,mag_y,mag_z,high_g_x,high_g_y,high_g_z,drag_force,apogee_prediction,desired_drag_force\r\n");
first_call = false;
}
const log_entry_t* packet = reinterpret_cast<const log_entry_t *>(entry);
printf("%" PRIu64 ",", packet->time_us);
state_t state = (state_t) packet->state;
switch (state) {
case PAD:
printf("PAD");
break;
case BOOST:
printf("BOOST");
break;
case COAST:
printf("COAST");
break;
case APOGEE:
printf("APOGEE");
break;
case RECOVERY:
printf("RECOVERY");
break;
case END:
printf("END");
break;
}
printf(",");
const float conversionFactor = 3.3f / (1 << 12);
float tempC = 27.0f - (((float)(packet->temperature_chip) * conversionFactor) - 0.706f) / 0.001721f;
printf("%4.2f,", tempC);
printf("%d,", packet->deploy_percent);
printf("%4.2f,", ((float) packet->pressure) / PRESSURE_SCALE_F);
printf("%4.2f,", ((float) packet->altitude) / ALTITUDE_SCALE_F);
printf("%4.2f,", (fix16_to_float(packet->altitude_filt)));
printf("%4.2f,", (fix16_to_float(packet->velocity_filt)));
printf("%4.2f,", ((float) packet->temperature_alt) / TEMPERATURE_SCALE_F);
printf("%4.2f,", IIM42653::scale_accel(packet->ax));
printf("%4.2f,", IIM42653::scale_accel(packet->ay));
printf("%4.2f,", IIM42653::scale_accel(packet->az));
printf("%4.2f,", IIM42653::scale_gyro(packet->gx));
printf("%4.2f,", IIM42653::scale_gyro(packet->gy));
printf("%4.2f,", IIM42653::scale_gyro(packet->gz));
printf("%" PRIi16 ",", packet->mag_x);
printf("%" PRIi16 ",", packet->mag_y);
printf("%" PRIi16 ",", packet->mag_z);
printf("%4.2f,", ADXL375::scale(packet->high_g_x));
printf("%4.2f,", ADXL375::scale(packet->high_g_y));
printf("%4.2f,", ADXL375::scale(packet->high_g_z));
printf("%4.2f,", (fix16_to_float(packet->drag_force)));
printf("%4.2f,", (fix16_to_float(packet->apogee_prediction)));
printf("%4.2f,", (fix16_to_float(packet->desired_drag_force)));
printf("\r\n");
stdio_flush();
}
|
