X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Ftelemini-v3.0%2Fao_telemini.c;h=d571d340f38919ee46f9ed6dd2f8ab1dd013b903;hb=HEAD;hp=c2c1323663f309f5cfd017c92ac719d2afdea8ba;hpb=c75736c9cd8f869c257a3024efda843cf0edf2a3;p=fw%2Faltos

diff --git a/src/telemini-v3.0/ao_telemini.c b/src/telemini-v3.0/ao_telemini.c
index c2c13236..d571d340 100644
--- a/src/telemini-v3.0/ao_telemini.c
+++ b/src/telemini-v3.0/ao_telemini.c
@@ -1,9 +1,10 @@
 /*
- * Copyright © 2011 Keith Packard <keithp@keithp.com>
+ * Copyright © 2017 Keith Packard <keithp@keithp.com>
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; version 2 of the License.
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
  *
  * This program is distributed in the hope that it will be useful, but
  * WITHOUT ANY WARRANTY; without even the implied warranty of
@@ -18,13 +19,32 @@
 #include <ao.h>
 #include <ao_exti.h>
 
-void
+#if HAS_FORCE_FREQ
+static void
+ao_check_recovery(void)
+{
+	int	i;
+	ao_enable_input(AO_RECOVERY_PORT, AO_RECOVERY_PIN, AO_RECOVERY_MODE);
+	for (i = 0; i < 100; i++)
+		ao_arch_nop();
+	if (ao_gpio_get(AO_RECOVERY_PORT, AO_RECOVERY_PIN) == AO_RECOVERY_VALUE) {
+		ao_flight_force_idle = 1;
+		ao_force_freq = 1;
+	}
+	ao_gpio_set_mode(AO_RECOVERY_PORT, AO_RECOVERY_PIN, 0);
+	ao_disable_port(AO_RECOVERY_PORT);
+}
+#endif
+
+int
 main(void)
 {
+#if HAS_FORCE_FREQ
+	ao_check_recovery();
+#endif
+
 	ao_clock_init();
 	ao_task_init();
-	ao_led_init(LEDS_AVAILABLE);
-	ao_led_on(AO_LED_GREEN);
 	ao_timer_init();
 
 	ao_dma_init();
@@ -38,6 +58,9 @@ main(void)
 #endif
 #if HAS_SERIAL_1
 	ao_serial_init();
+#endif
+#if HAS_USB
+	ao_usb_init();
 #endif
 	ao_cmd_init();
 
@@ -49,7 +72,7 @@ main(void)
 	ao_report_init();
 	ao_telemetry_init();
 	ao_radio_init();
-	ao_packet_slave_init(TRUE);
+	ao_packet_slave_init(true);
 	ao_igniter_init();
 	ao_config_init();