X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fao_flight.c;h=e91a5daa74c97cc77f03b6d3030657c6f061a45e;hp=be9b3bb6f4cfdbf4e55a9681dac98bbec304b471;hb=ca5d323a3d206050d95f52a61e92c69e1f54e7b5;hpb=0f2cbd41332b1b63865c5f1a4e749419b469853a

diff --git a/src/ao_flight.c b/src/ao_flight.c
index be9b3bb6..e91a5daa 100644
--- a/src/ao_flight.c
+++ b/src/ao_flight.c
@@ -227,6 +227,7 @@ ao_flight(void)
 
 				/* Turn on telemetry system
 				 */
+				ao_rdf_set(1);
 				ao_telemetry_set_interval(AO_TELEMETRY_INTERVAL_PAD);
 
 				ao_flight_state = ao_flight_pad;
@@ -234,9 +235,9 @@ ao_flight(void)
 			} else {
 				ao_flight_state = ao_flight_idle;
 
-				/* Turn on the Green LED in idle mode
+				/* Turn on packet system in idle mode
 				 */
-				ao_led_on(AO_LED_GREEN);
+				ao_packet_slave_start();
 				ao_wakeup(DATA_TO_XDATA(&ao_flight_state));
 			}
 			/* signal successful initialization by turning off the LED */
@@ -277,6 +278,9 @@ ao_flight(void)
 				/* Increase telemetry rate */
 				ao_telemetry_set_interval(AO_TELEMETRY_INTERVAL_FLIGHT);
 
+				/* disable RDF beacon */
+				ao_rdf_set(0);
+
 				ao_wakeup(DATA_TO_XDATA(&ao_flight_state));
 				break;
 			}
@@ -438,6 +442,8 @@ ao_flight(void)
 
 				/* turn off the ADC capture */
 				ao_timer_set_adc_interval(0);
+				/* Enable RDF beacon */
+				ao_rdf_set(1);
 
 				ao_wakeup(DATA_TO_XDATA(&ao_flight_state));
 			}
@@ -452,7 +458,7 @@ ao_flight(void)
 #define AO_VEL_COUNT_TO_MS(count)	((int16_t) ((count) / 2700))
 
 static void
-ao_flight_status(void)
+ao_flight_status(void) __reentrant
 {
 	printf("STATE: %7s accel: %d speed: %d altitude: %d main: %d\n",
 	       ao_state_names[ao_flight_state],