X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fcore%2Fao_flight.c;h=494e656d5ccd3dabe5139cdd1dab6303ba84c8d0;hb=84f9a525c64491afa9b7a565e3c10a4cee106e14;hp=433efeae6cc1d48e2db378dd379292485f007ab8;hpb=f6f54d70b768dca1715ddddea64a4df00d82b09e;p=fw%2Faltos

diff --git a/src/core/ao_flight.c b/src/core/ao_flight.c
index 433efeae..494e656d 100644
--- a/src/core/ao_flight.c
+++ b/src/core/ao_flight.c
@@ -40,9 +40,11 @@ __pdata uint16_t		ao_boost_tick;		/* time of launch detect */
  * track min/max data over a long interval to detect
  * resting
  */
-__pdata uint16_t		ao_interval_end;
-__pdata int16_t			ao_interval_min_height;
-__pdata int16_t			ao_interval_max_height;
+static __data uint16_t		ao_interval_end;
+static __data int16_t		ao_interval_min_height;
+static __data int16_t		ao_interval_max_height;
+static __data int16_t		ao_coast_avg_accel;
+
 __pdata uint8_t			ao_flight_force_idle;
 
 /* We also have a clock, which can be used to sanity check things in
@@ -197,6 +199,7 @@ ao_flight(void)
 			{
 #if HAS_ACCEL
 				ao_flight_state = ao_flight_fast;
+				ao_coast_avg_accel = ao_accel;
 #else
 				ao_flight_state = ao_flight_coast;
 #endif
@@ -220,6 +223,17 @@ ao_flight(void)
 #endif
 		case ao_flight_coast:
 
+			/*
+			 * By customer request - allow the user
+			 * to lock out apogee detection for a specified
+			 * number of seconds.
+			 */
+			if (ao_config.apogee_lockout) {
+				if ((ao_sample_tick - ao_boost_tick) <
+				    AO_SEC_TO_TICKS(ao_config.apogee_lockout))
+					break;
+			}
+
 			/* apogee detect: coast to drogue deploy:
 			 *
 			 * speed: < 0
@@ -250,7 +264,8 @@ ao_flight(void)
 #if HAS_ACCEL
 			else {
 			check_re_boost:
-				if (ao_accel > AO_MSS_TO_ACCEL(20)) {
+				ao_coast_avg_accel = ao_coast_avg_accel - (ao_coast_avg_accel >> 6) + (ao_accel >> 6);
+				if (ao_coast_avg_accel > AO_MSS_TO_ACCEL(20)) {
 					ao_boost_tick = ao_sample_tick;
 					ao_flight_state = ao_flight_boost;
 					ao_wakeup(DATA_TO_XDATA(&ao_flight_state));