From: Keith Packard <keithp@keithp.com>
Date: Thu, 17 Feb 2022 01:00:59 +0000 (-0800)
Subject: altos: Re-enable apogee delay
X-Git-Tag: 1.9.10.4~53
X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=commitdiff_plain;h=85dd82b200d649fbf08aa31e5acde8f1f40d531a

altos: Re-enable apogee delay

When the igniter code was changed to support booster mode, the code
which delayed apogee firing based on the configure apogee delay value
was lost. Re-enable that by sticking a delay before firing the drogue
charge when the ignite mode is not redundant apogee.

Signed-off-by: Keith Packard <keithp@keithp.com>
---

diff --git a/src/kernel/ao_ignite.c b/src/kernel/ao_ignite.c
index d197239a..86a116d1 100644
--- a/src/kernel/ao_ignite.c
+++ b/src/kernel/ao_ignite.c
@@ -82,6 +82,9 @@ ao_igniter_fire(enum ao_igniter igniter, bool wait)
 		ao_ignition[igniter].fired = 1;
 		switch (igniter) {
 		case ao_igniter_drogue:
+			if (wait && ao_config.apogee_delay &&
+			    ao_config.ignite_mode != AO_IGNITE_MODE_MAIN)
+				ao_delay(AO_SEC_TO_TICKS(ao_config.apogee_delay));
 			AO_IGNITER_SET_DROGUE(1);
 			ao_delay(AO_IGNITER_FIRE_TIME);
 			AO_IGNITER_SET_DROGUE(0);