altos: Signal ascent using P1_2 (0 = ascent, 1 = other)

[fw/altos] / src / ao_flight.c

diff --git a/src/ao_flight.c b/src/ao_flight.c
index c6cbbf7cbaeb3e26f64bf6069e427fe864f4a561..cfecc5af5d770509d1341a63ae958d4e92550891 100644 (file)
--- a/src/ao_flight.c
+++ b/src/ao_flight.c
@@ -168,6 +168,9 @@ ao_flight(void)
                                ao_wakeup(&ao_gps_data);
                                ao_wakeup(&ao_gps_tracking_data);
 #endif
+#ifdef ASCENT_PIN
+                               ASCENT_PIN = 0;
+#endif
 
                                ao_wakeup(DATA_TO_XDATA(&ao_flight_state));
                                break;
@@ -237,6 +240,9 @@ ao_flight(void)
                                /* Turn the RDF beacon back on */
                                ao_rdf_set(1);
 
+#ifdef ASCENT_PIN
+                               ASCENT_PIN = 1;
+#endif
                                /*
                                 * Start recording min/max height
                                 * to figure out when the rocket has landed
@@ -313,6 +319,11 @@ static __xdata struct ao_task      flight_task;
 void
 ao_flight_init(void)
 {
+#ifdef ASCENT_SIGNAL
+       ASCENT_SIGNAL = 1;
+       ASCENT_SIGNAL_DIR |= (1 << ASCENT_SIGNAL_PIN);
+       ASCENT_SIGNAL_SEL &= ~(1 << ASCENT_SIGNAL_PIN);
+#endif
        ao_flight_state = ao_flight_startup;
        ao_add_task(&flight_task, ao_flight, "flight");
 }