#include <stdlib.h>
#include <string.h>
+#define AO_HERTZ 100
+
#define AO_ADC_RING 64
#define ao_adc_ring_next(n) (((n) + 1) & (AO_ADC_RING - 1))
#define ao_adc_ring_prev(n) (((n) - 1) & (AO_ADC_RING - 1))
struct ao_config {
uint16_t main_deploy;
- int16_t accel_zero_g;
+ int16_t accel_plus_g;
+ int16_t accel_minus_g;
};
#define ao_config_get()
-struct ao_config ao_config = { 250, 16000 };
+struct ao_config ao_config;
+
+#define DATA_TO_XDATA(x) (x)
#include "ao_flight.c"
ao_sleep(void *wchan)
{
ao_dump_state();
- if (wchan == &ao_adc_ring) {
+ if (wchan == &ao_adc_head) {
char type;
uint16_t tick;
uint16_t a, b;
type = words[0][0];
tick = strtoul(words[1], NULL, 16);
a = strtoul(words[2], NULL, 16);
- b = strtoul(words[2], NULL, 16);
+ b = strtoul(words[3], NULL, 16);
+ } else if (nword >= 6 && strcmp(words[0], "Accel")) {
+ ao_config.accel_plus_g = atoi(words[3]);
+ ao_config.accel_minus_g = atoi(words[5]);
+ } else if (nword >= 4 && strcmp(words[0], "Main")) {
+ ao_config.main_deploy = atoi(words[2]);
} else if (nword >= 36 && strcmp(words[0], "CALL") == 0) {
tick = atoi(words[10]);
if (!ao_flight_started) {
switch (type) {
case 'F':
ao_flight_ground_accel = a;
+ if (ao_config.accel_plus_g == 0) {
+ ao_config.accel_plus_g = a;
+ ao_config.accel_minus_g = a + 530;
+ }
+ if (ao_config.main_deploy == 0)
+ ao_config.main_deploy = 250;
ao_flight_started = 1;
break;
case 'S':