X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fao_sample.c;h=84cf1e00b8f70aba0ddf42427b7195b8a8297981;hp=ef403393cb6c276fbd81c38c46cbe4f559d3dd1a;hb=8db5c52f1c76a05020e4e0afbe4ea27485ad9f82;hpb=c754759a2d503633d527da4ebb20eb859cd506fd

diff --git a/src/ao_sample.c b/src/ao_sample.c
index ef403393..84cf1e00 100644
--- a/src/ao_sample.c
+++ b/src/ao_sample.c
@@ -68,16 +68,17 @@ ao_sample_preflight(void)
 #endif
 		ao_sample_pres_sum += ao_sample_pres;
 		++nsamples;
-		ao_preflight = FALSE;
-	}
-	ao_config_get();
+	} else {
+		ao_config_get();
 #if HAS_ACCEL
-	ao_ground_accel = ao_sample_accel_sum >> 9;
-	ao_accel_2g = ao_config.accel_minus_g - ao_config.accel_plus_g;
-	ao_accel_scale = to_fix32(GRAVITY * 2 * 16) / ao_accel_2g;
+		ao_ground_accel = ao_sample_accel_sum >> 9;
+		ao_accel_2g = ao_config.accel_minus_g - ao_config.accel_plus_g;
+		ao_accel_scale = to_fix32(GRAVITY * 2 * 16) / ao_accel_2g;
 #endif
-	ao_ground_pres = ao_sample_pres_sum >> 9;
-	ao_ground_height = ao_pres_to_altitude(ao_ground_pres);
+		ao_ground_pres = ao_sample_pres_sum >> 9;
+		ao_ground_height = ao_pres_to_altitude(ao_ground_pres);
+		ao_preflight = FALSE;
+	}
 }
 
 uint8_t