X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fao_flight.c;fp=src%2Fao_flight.c;h=8e370c4fa16d7d1eb86bbff1e99ae266feceebbd;hp=843865e8f83d82188f2c3bdf63cb9254c87a494b;hb=2d41358c80f2eb8b6e98d699149bb941a6671475;hpb=1e56ed44e562f808addfd76bfb352f981db94094

diff --git a/src/ao_flight.c b/src/ao_flight.c
index 843865e8..8e370c4f 100644
--- a/src/ao_flight.c
+++ b/src/ao_flight.c
@@ -358,10 +358,6 @@ ao_flight(void)
 				 * (or uncalibrated values), so we go into invalid mode
 				 */
 				ao_flight_state = ao_flight_invalid;
-				/* Allow packet mode in invalid flight state,
-				 * Still need to be able to fix the problem!
-				 */
-				ao_packet_slave_start();
 
 			} else
 #endif
@@ -380,6 +376,10 @@ ao_flight(void)
 				 */
 				ao_usb_disable();
 #endif
+
+				/* Disable packet mode in pad state */
+				ao_packet_slave_stop();
+
 				/* Turn on telemetry system */
 				ao_rdf_set(1);
 				ao_telemetry_set_interval(AO_TELEMETRY_INTERVAL_PAD);
@@ -390,9 +390,6 @@ ao_flight(void)
 				/* Set idle mode */
  				ao_flight_state = ao_flight_idle;
  
-				/* Turn on packet system in idle mode */
-				ao_packet_slave_start();
-
 				/* signal successful initialization by turning off the LED */
 				ao_led_off(AO_LED_RED);
 			}