X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fmicropeak%2Fao_micropeak.c;h=10f0d19206e436e08912fc69616a41c453a1ca25;hb=39475c7b8da4f29936f73ffa2bff112f50ee9328;hp=8201280000e9d8c2cfd0491976501529a92b318f;hpb=65b512c890a3ccf487655b79305ab1cfcf49259c;p=fw%2Faltos

diff --git a/src/micropeak/ao_micropeak.c b/src/micropeak/ao_micropeak.c
index 82012800..10f0d192 100644
--- a/src/micropeak/ao_micropeak.c
+++ b/src/micropeak/ao_micropeak.c
@@ -24,16 +24,10 @@
 static struct ao_ms5607_sample	sample;
 static struct ao_ms5607_value	value;
 
-uint32_t	pa;
-uint32_t	pa_avg;
-uint32_t	pa_ground;
-uint32_t	pa_min;
 alt_t		ground_alt, max_alt;
 alt_t		ao_max_height;
 
-static uint32_t	pa_sum;
-
-static void
+void
 ao_pa_get(void)
 {
 	ao_ms5607_sample(&sample);
@@ -63,11 +57,6 @@ ao_pips(void)
 int
 main(void)
 {
-	int16_t		sample_count;
-	uint16_t	time;
-	uint32_t	pa_interval_min, pa_interval_max;
-	int32_t		pa_diff;
-
 	ao_led_init(LEDS_AVAILABLE);
 	ao_timer_init();
 
@@ -86,77 +75,9 @@ main(void)
 	ao_log_micro_dump();
 	
 	ao_delay(BOOST_DELAY);
-	/* Wait for motion, averaging values to get ground pressure */
-	time = ao_time();
-	ao_pa_get();
-	pa_avg = pa_ground = pa << FILTER_SHIFT;
-	sample_count = 0;
-	for (;;) {
-		time += SAMPLE_SLEEP;
-		if (sample_count == 0)
-			ao_led_on(AO_LED_REPORT);
-		ao_delay_until(time);
-		ao_pa_get();
-		if (sample_count == 0)
-			ao_led_off(AO_LED_REPORT);
-		pa_avg = pa_avg - (pa_avg >> FILTER_SHIFT) + pa;
-		pa_diff = pa_ground - pa_avg;
-
-		/* Check for a significant pressure change */
-		if (pa_diff > (BOOST_DETECT << FILTER_SHIFT))
-			break;
-
-		if (sample_count < GROUND_AVG * 2) {
-			if (sample_count < GROUND_AVG)
-				pa_sum += pa;
-			++sample_count;
-		} else {
-			pa_ground = pa_sum >> (GROUND_AVG_SHIFT - FILTER_SHIFT);
-			pa_sum = 0;
-			sample_count = 0;
-		}
-	}
-
-	pa_ground >>= FILTER_SHIFT;
-
-	/* Now sit around until the pressure is stable again and record the max */
 
-	sample_count = 0;
-	pa_min = pa_avg;
-	pa_interval_min = pa_avg;
-	pa_interval_max = pa_avg;
-	for (;;) {
-		time += SAMPLE_SLEEP;
-		ao_delay_until(time);
-		if ((sample_count & 3) == 0)
-			ao_led_on(AO_LED_REPORT);
-		ao_pa_get();
-		if ((sample_count & 3) == 0)
-			ao_led_off(AO_LED_REPORT);
-		if (sample_count & 1)
-			ao_log_micro_data();
-		pa_avg = pa_avg - (pa_avg >> FILTER_SHIFT) + pa;
-		if (pa_avg < pa_min)
-			pa_min = pa_avg;
-
-		if (sample_count == (GROUND_AVG - 1)) {
-			pa_diff = pa_interval_max - pa_interval_min;
+	ao_microflight();
 
-			/* Check to see if the pressure is now stable */
-			if (pa_diff < (LAND_DETECT << FILTER_SHIFT))
-				break;
-			sample_count = 0;
-			pa_interval_min = pa_avg;
-			pa_interval_max = pa_avg;
-		} else {
-			if (pa_avg < pa_interval_min)
-				pa_interval_min = pa_avg;
-			if (pa_avg > pa_interval_max)
-				pa_interval_max = pa_avg;
-			++sample_count;
-		}
-	}
-	pa_min >>= FILTER_SHIFT;
 	ao_log_micro_save();
 	ao_compute_height();
 	ao_report_altitude();