Initialize ao_min_vel with |ao_flight_vel|

[fw/altos] / ao_flight.c

diff --git a/ao_flight.c b/ao_flight.c
index 43fd98b2ba3da26c607682e00a063f88c6394bf4..91953975203c830fa76814e1cd02fb35fc33a68b 100644 (file)
--- a/ao_flight.c
+++ b/ao_flight.c
@@ -223,7 +223,7 @@ ao_flight(void)
                                /* Turn on telemetry system
                                 */
                                ao_rdf_set(1);
-                               ao_telemetry_set_interval(AO_TELEMETRY_INTERVAL_FLIGHT);
+                               ao_telemetry_set_interval(AO_TELEMETRY_INTERVAL_PAD);
 
                                ao_flight_state = ao_flight_launchpad;
                                ao_wakeup(DATA_TO_XDATA(&ao_flight_state));
@@ -259,6 +259,9 @@ ao_flight(void)
                                /* start logging data */
                                ao_log_start();
 
+                               /* Increase telemetry rate */
+                               ao_telemetry_set_interval(AO_TELEMETRY_INTERVAL_FLIGHT);
+
                                /* disable RDF beacon */
                                ao_rdf_set(0);
 
@@ -309,7 +312,7 @@ ao_flight(void)
                                /* set min velocity to current velocity for
                                 * apogee detect
                                 */
-                               ao_min_vel = ao_flight_vel;
+                               ao_min_vel = abs(ao_flight_vel);
                                ao_flight_state = ao_flight_apogee;
                                ao_wakeup(DATA_TO_XDATA(&ao_flight_state));
                        }