Add apogee igniter delay.

[fw/altos] / src / ao_ignite.c

diff --git a/src/ao_ignite.c b/src/ao_ignite.c
index be2915234b07d7a2c477e78c445baeb0e9f03866..8206e342ef2f5c119a41ddb1420d1531f7d7522e 100644 (file)
--- a/src/ao_ignite.c
+++ b/src/ao_ignite.c
@@ -103,10 +103,14 @@ ao_igniter(void)
        __xdata enum ao_ignter igniter;
        __xdata enum ao_igniter_status status;
 
+       ao_config_get();
        for (;;) {
                ao_sleep(&ao_ignition);
                for (igniter = ao_igniter_drogue; igniter <= ao_igniter_main; igniter++) {
                        if (ao_ignition[igniter].request && !ao_ignition[igniter].fired) {
+                               if (igniter == ao_igniter_drogue && ao_config.apogee_delay)
+                                       ao_delay(AO_SEC_TO_TICKS(ao_config.apogee_delay));
+
                                ao_igniter_fire(igniter);
                                ao_delay(AO_IGNITER_CHARGE_TIME);
                                status = ao_igniter_status(igniter);