altos: Respect apogee lockout time in flight algorithm

[fw/altos] / src / core / ao_flight.c

diff --git a/src/core/ao_flight.c b/src/core/ao_flight.c
index 5e19463867bb85718dabbd7ec93c9cce256290f8..494e656d5ccd3dabe5139cdd1dab6303ba84c8d0 100644 (file)
--- a/src/core/ao_flight.c
+++ b/src/core/ao_flight.c
@@ -223,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